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ABSTRACT 


A  position  measuring  system  for  a  remotely  controlled  video  camera  was  designed 
and  built.  The  camera  is  intended  to  be  used  with  the  modified  Advance  Development 
Model  of  the  AN/SAR-8  Infrared  Search  and  Target  Designation  System  (IRSTD)  in 
use  at  the  Naval  Postgraduate  School.  The  video  data  collected  by  the  camera  will  be 
correlated  with  the  infrared  data  from  the  IRSTD  to  develop  a  background  data  base 
that  will  be  used  in  the  developement  of  signal  processing  algorithms. 

The  measurement  system  uses  two  Hewlett  Packard  HEDS-6000  incremental  pptical 
encoders,  two  Motorola  MC68705U3  microprocessors  and  two  digital  display  devices  to 
measure  and  present  the  camera's  azimuth  and  elevation  angles  to  an  operator  at  a  re¬ 
mote  location.  The  azimuth  can  be  measured  over  a  range  of  360°  with  a  resolution  of 

■£ 0.0213°  and  the  elevation  can  be  measured  over  24°  with  a  resolution  of  £  0.138°. 

'  \ 

The  resolution  is  limited  primarily  by  hysteresis,  which  is  due  to  the  backlash  in  t^e  gears^ 
between  the  transducers  and  the  axes  of  interest.  f  '  / 
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THESIS  DISCLAIMER 


The  reader  is  cautioned  that  computer  programs  developed  in  this  research  may  not 
have  been  exercised  for  all  cases  of  interest.  While  every  effort  has  been  made,  within 
the  time  available,  to  ensure  that  the  programs  are  free  of  computational  and  logic  er¬ 
rors,  they  cannot  be  considered  validated.  Any  application  of  these  programs  without 
additional  verification  is  at  the  risk  of  the  user. 
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I.  INTRODUCTION 


A.  BACKGROUND 

The  old  saying  that  “every  solution  breeds  new  problems”,  while  somewhat  pessi¬ 
mistic,  quite  often  rings  true  in  today's  increasingly  technical  world.  One  such  example 
is  the  use  of  infrared  (IR)  sensors  for  the  detection,  tracking  and  or  identification  of 
targets  in  a  combat  environment.  IR  sensors  are  ideally  suited  for  use  on  today's  bat¬ 
tlefield.  They  are  passive,  i.e.,  they  do  not  need  to  emit  energy  in  order  to  detect  the 
presence  of  potential  targets.  This  allows  them  to  operate  during  times  of  emission 
control  when  many  other  target  detection  systems  are  useless.  They  have  the  ability  to 
“see  through”  many  forms  of  camouflage  and  concealment,  dust,  clouds,  smoke,  etc., 
that  might  otherwise  afford  an  enemy  target  a  safe  haven.  Additionally,  because  almost 
everything  on  today's  battlefield  generates  some  degree  of  infrared  energy,  IR  sensors 
can  be  used  to  locate  and  identify  a  wide  variety  of  targets. 

The  extent  to  which  a  particular  IR  sensor  is  useful  depends  primarily  on  its  ability 
to  detect  and  identify  targets  reliably  and  accurately.  Detection  of  the  target  is  primarily 
a  function  of  the  IR  sensor's  sensitivity.  The  classification  of  a  received  IR  signal  as  a 
potential  target  or  as  background  noise,  while  still  dependant  on  the  sensitivity  of  the 
sensors,  is  primarily  a  function  of  the  quality  of  the  signal  processing  algorithms  being 
used  to  process  the  received  signals.  In  addition  to  being  reliable  these  algorithms  must 
be  able  to  process  the  received  signals  in  “real  time”  if  the  system  is  to  be  an  effective 
weapons  system. 

Creation  of  a  background  data  base  that  can  be  used  to  test  some  of  these  algo¬ 
rithms  has  been  one  of  the  tasks  being  performed  by  the  Naval  Academic  Center  for 
Infrared  Technology  (NACIT)  located  at  the  Naval  Postgraduate  School  (NPS).  The 
Advanced  Development  Model  (ADM)  of  the  AN/SAR-8  was  sent  to  the  NACIT  in 
January  of  1984  from  the  Naval  Surface  Weapons  Center  (NSWC)  at  Dahlgren, 
Virginia.  The  ADM  was  modified,  calibrated  and  placed  in  service  at  NPS  in  December, 
19S7.  The  modified  version  of  the  ADM,  the  Infrared  Search  and  Target  Designation 
(IRSTD)  System,  is  currently  operational  at  NPS.  [Ref.  1:  pp.  8-12] 

One  way  to  enhance  the  usefulness  of  the  IR  data  being  collected  at  NPS  would  be 
to  collect  video  data  concurrently  with  the  IR  data.  A  video  image  of  a  portion  of  the 
horizon  would  permit  visual  identification  of  IR  sources  in  that  region.  This  additional 
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tional  information  could  be  an  aid  in  the  development  of  the  signal  processing  algo¬ 
rithms  for  the  IRSTD.  Accordingly,  a  decision  to  proceed  with  video  data  collection 
was  made  by  NACIT,  and  a  camera  system  was  purchased.  Components  of  the  system 
include; 

•  RCA  (TC1005  01),  Closed  circuit  video  camera. 

•  PELCO  (AI700),  Automatic  iris  servo. 

•  PELCO  (F1.5X),  1.5  times  range  extender. 

•  PELCO  (MLZ6DT),  Desk  top  lens  remote  control  module. 

•  PELCO  (PT1250DC),  Heavy  duty  Pan/Tilt  servo. 

•  PELCO  (MPTV1510DT),  Pan/Tilt  remote  control  unit. 

•  Panasonic  (WV-5410),  Video  Monitor. 

In  Ref.  1  Ayers  describes  the  IRSTD's  detectors: 

The  1 R  detectors  consist  of  two  vertical  arrays  of  sensing  elements  in  the  focal  plane 
of  the  Schmidt  telescope.  The  telescope  is  rotated  so  as  to  sweep  the  image  across 
the  detector  arrays.  Each  array  incorporates  a  column  of  90  indium  antimonide 
photovoltic  linear  detector  elements.  These  two  arrays  are  independent  of  each 
other  and  are  covered  by  filters  which  pass  selected  wavebands  of  IR  radiation  in  the 
3  to  5  micrometer  range.  Each  element  has  the  angular  dimensions  of  2  X  .3 
milliradians  with  the  larger  being  its  height.  Designated  as  the  lead  and  the  lag, 
these  two  arrays  are  separated  by  about  one-half  degree  in  azimuth.  [Ref.  1:  p.  17] 

Thus,  as  the  IRSTD  scans  the  horizon  the  resulting  IR  image  has  a  resolution  of  ap¬ 
proximately  lO-4  radians  (0.00573°)  in  the  horizontal  plane  and  0.23°  in  the  vertical 
plane.  The  video  system  s  smaller  field  of  view  can  be  remotely  controlled  using  the 
control  units  listed  above.  Thus,  for  the  video  data  to  be  of  any  use  in  the  development 
of  the  signal  processing  algorithms,  the  camera's  orientation  must  first  be  known,  and, 
in  order  to  determine  the  pixel-to-pixel  correlation  between  the  IR  image  and  the  video 
image,  the  position  of  the  video  camera  needs  to  be  known  with  the  same  kind  of  accu¬ 
racy  as  the  IR  image.  The  design  and  implementation  of  a  position  measuring  system 
for  this  remotely  controlled  video  camera  is  the  subject  of  this  thesis. 

B.  DESIGN  SPECIFICATIONS 

The  design  specifications  for  this  problem  were  relatively  straight  forward.  The  po¬ 
sition  measuring  system  needed  to  meet  the  following  criteria. 

•  The  system  should  be  able  to  measure  the  elevation  angle  (tilt),  above  and  below 
the  horizontal  reference  plane  of  the  camera  over  a  range  of  ±  12°. 

•  The  measured  elevation  angle  should  be  accurate  to  within  ±  0.23°  . 
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•  The  system  should  be  able  to  measure  the  bearing  (pan),  left  or  right  of  some  ar¬ 
bitrary  reference,  of  the  camera  over  a  range  of  360°. 

•  The  measured  bearing  should  be  accurate  to  within  ±  10~*  radians. 

•  The  output  should  be  displayed  in  a  convenient  form.  The  display  should  be 
collocated  with  the  camera  servo  remote  controls,  an  indoor  site  approximately  200 
meters  away  from  the  camera. 

•  Portions  of  the  measuring  system  required  to  be  collocated  with  the  camera  should 
be  weatherproofed. 

•  The  system  must  be  reliable  and  should  be  simple  to  operate. 
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II.  DESIGN  STRATEGY 


A.  GENERAL 

A  position  measuring  system,  like  any  system,  is  a  combination  of  devices  intercon¬ 
nected  to  perform  a  certain  function.  The  most  basic  position  measuring  system  (see 
Figure  1)  consists  of  only  four  such  devices:  a  transducer,  a  signal  conditioner,  a  display 
device  and  a  power  supply.  More  complicated  position  measuring  systems  include  those 
designed  to  take  a  number  of  different  measurements  either  simultaneously  or  consec¬ 
utively.  Still  more  complex  systems  multiplex  these  various  measurements  over  a  single 
channel  to  some  distant  location  where  they  can  be  processed  and  displayed.  [Ref.  2: 
pp.  2-14] 

The  design  specifications  for  the  camera  position  measurement  system  (subsequently 
referred  to  as  the  “measurement  system”)  required  that  two  measurements,  pan  and  tilt, 
be  taken  simultaneously  and  transmitted  some  distance  to  a  remote  display.  Two  sepa¬ 
rate  transducers,  capable  of  independent  operation,  were  therefore  required.  In  order  for 
both  the  azimuth  and  the  elevation  to  be  displayed  simultaneously  two  display  devices 
were  also  required. 

Several  pairs  of  RG-178  coaxial  cable  were  available  to  transmit  signals  between  the 
camera  servo  and  the  remote  control  site.  Since  the  cable  was  available  and  it  was  de¬ 
sirable  to  reduce  the  system  complexity,  a  decision  was  made  not  to  multiplex  the  data 
over  a  single  channel.  Instead,  each  measurand  would  have  a  separate  transducer,  a 
dedicated  signal  processor  and  a  unique  display  device.  Position  information  for  each 
axis  would  be  transmitted  over  a  dedicated  channel. 

The  physical  locations  of  the  transducers  and  the  display  devices  were  dictated  by 
the  design  specifications;  however,  there  was  some  flexibility  in  deciding  where  to  locate 
the  signal  conditioner.  Site  selection  was  based  on  an  attempt  to  maximize  total  system 
performance  and  simplicity  while  ensuring  the  maintainability  and  environmental  integ¬ 
rity  of  the  signal  conditioner.  The  only  advantage  to  locating  the  signal  conditioner  with 
the  camera  servo  and  the  transducer  would  have  been  to  limit  the  distance  that  the 
transducer's  output  signal  would  have  to  be  transmitted  to  the  processor.  On  the  other 
hand,  separating  the  signal  conditioner  and  the  transducers  would  limit  the  distance  over 
which  the  conditioned  signal  would  have  to  be  transmitted  to  the  display  device.  The 
trade-off  here  was  not  clear  cut  and  would  probably  depend  on  the  specific  hardware 
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Figure  1.  Basic  Electronic  Position  Measuring  System:  From  Ref.  2:  p.  2 


used  and  the  speed  of  rotation  of  the  camera  servo.  There  was  one  significant  advan¬ 
tage,  however,  to  collocating  the  display  and  the  signal  processor;  since  they  would  both 
be  indoors,  the  need  for  weatherproofing  the  signal  processor  would  be  eliminated. 

Power  was  available  at  both  ends  of  the  system,  there  was  therefore  no  requirement 
to  have  a  conunon  power  supply  for  the  entire  system.  One  supply  could  be  used  to 
provide  power  to  the  two  transducers,  collocated  with  the  camera  servo,  and  a  second 
supply  could  power  the  signal  conditioner  and  the  displays. 

A  block  diagram  of  the  prototype  measurement  system  is  shown  interconnected  with 
the  camera  positioning  system  in  Figure  2.  Once  this  basic  system  layout  had  been  de¬ 
termined,  proper  selection  of  the  actual  hardware  was  necessary.  The  design  criteria 
were  the  primary  consideration  in  the  initial  stages  of  the  hardware  selection.  Final  se¬ 
lection  of  the  specific  components,  however,  involved  balancing  additional  factors,  such 
as  availability  and  cost  against  the  system  requirements. 


5 


6 


B.  TRANSDUCERS 
1.  General 

Since  in  practice  most  measurement  systems  do  not  have  the  ability  to  respond 
directly  to  the  measurand,  transducers  are  used  to  convert  one  physical  quantity  (e.g., 
angular  position)  into  another,  more  usable  quantity  or  signal  (e.g.,  an  electrical  signal) 
[Ref.  3:  p.  1-4].  The  transducer  is  therefore  a  vital  part  of  any  measurement  system,  and 
although  none  of  the  components  of  this  system  could  have  been  chosen  independently 
of  the  other  elements,  proper  transducer  selection  appeared  to  be  the  key  to  meeting  the 
design  specifications.  Thus,  selection  of  a  transducer  was  the  next  step  in  the  design 
process. 

Using  the  selection  guidelines  given  by  Norton  on  pages  51-53  of  Ref  2  and  the 
design  criteria  stated  previously,  several  observations  and  decisions  were  made  which 
significantly  reduced  the  number  of  transducers  considered  feasible  for  use  in  the  meas¬ 
urement  system.  The  fact  that  the  servo  was  capable  of  rotating  the  camera  left  or  right, 
and  up  or  down  suggested  that  the  transducer  should  be  capable  of  detecting  both  in¬ 
creasing  and  decreasing  angles  on  both  axes.  Additionally,  since  the  servo  was  antic¬ 
ipated  to  rotate  the  camera  through  one  360°  arc  in  the  horizontal  plane,  the  transducer 
used  to  measure  this  angle  (subsequently  referred  to  as  the  “pan  transducer”)  needed  to 
have  a  comparable  range  capability.  The  range  requirement  for  the  “tilt  transducer” 
(used  to  measure  the  elevation  angle)  was  much  less  restrictive.  These  factors,  angular 
bidirectional  capability  and  full  scale  range,  eliminated  a  great  number  of  transducers 
from  the  list  of  candidates. 

The  list  was  further  narrowed  by  the  accuracy  requirements  previously  specified. 
Again  the  accuracy  in  the  horizontal  plane  placed  a  much  more  severe  limitation  on  the 
selection  of  a  transducer  than  the  accuracy  requirements  for  the  vertical  plane.  The 
following  paragraphs  in  this  section  outline  the  logic  used  in  the  selection  of  the 
transducers.  The  factors  considered  in  the  selection  process  included  the  following; 

•  The  accuracy  requirements  given  in  the  specifications. 

•  The  ease  with  which  a  specific  transducer  could  be  installed  on  the  servo. 

•  The  ability  to  weatherproof  the  servo  and  the  transducer  once  the  transducer  was 
installed. 

•  The  rotation  speed  of  the  camera  about  the  servo  axes. 

•  The  extent  to  which  a  particular  transducer/mounting  configuration  would  modify 
the  measurand. 

•  Cost  effectiveness. 
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•  Availability. 

•  Signal  conditioning  requirements. 

•  The  extent  to  which  the  selection  of  a  particular  transducer  would  simplify  or 
complicate  the  modification  or  expansion  of  the  measurement  system. 

2.  Transducer  technologies 

Displacement  transducer  technologies  fall  into  three  very  broad  categories  de¬ 
pending  on  whether  they  are  capable  of  measuring  linear  or  angular  displacement,  or 
both.  Some  technologies  could  be  eliminated  immediately  since  they  were  clearly  not 
suited  for  measuring  angular  position.  Strain  gauge  displacement  transducers,  inductive 
displacement  transducers  and  vibrating-wire  displacement  transducers  are  examples  of 
such  devices.  The  following  paragraphs  briefly  describe  the  different  transducer  tech¬ 
nologies  which  were  investigated.  Table  1  on  page  18  summarizes  the  salient  points  of 
the  discussion.  [Ref.  2:  pp.  90-117]. 

a.  Reluctive  Displacement  Transducers 

The  rotary  variable  differential  transformer  (RVDT),  which  operates  by 
detecting  a  change  in  the  reluctance  between  coils,  offers  excellent  resolution,  dynamic 
characteristics,  linearity  and  life  expectancy  [Ref.3:  p.  (2-14)].  Figure  3  shows  a  sche¬ 
matic  diagram  and  a  simplified  cross-section  of  an  RVDT.  The  ferromagnetic, 
cardioid-shaped  core  is  attached  to  a  shaft  as  shown.  As  the  shaft  rotates,  the  inductive 
coupling  between  the  primary  and  each  of  the  secondary  coils  changes.  When  the  cam 
is  symmetric  with  respect  to  the  two  secondary  coils,  their  output  voltages  are  equal  but 
opposite  in  phase  which  results  in  a  differential  output  voltage  of  zero.  As  the  shaft 
rotates  away  from  this  "null”  the  differential  output  voltage  varies  as  shown  in 
Figure  4.  The  linear  region  of  the  curve  is  limited  to  the  angles  between  ±  40°  of  the 
reference.  Thus,  the  RVDT  could  not  be  used  on  the  Pan  axis.  It  was  however,  initially 
considered  as  a  candidate  for  the  Tilt  transducer.  [Refs.  2:  pp.  93-99,  3: 
pp.  (9-10)-(9-13)  and  4:  p.  19] 

Another  type  of  reluctive  displacement  transducer  is  manufactured  by 
Farrand  Controls.  Their  INDUCTOSYN  rotary  position  transducers  have  accuracies 
to  ±  1.5  arc  sec  (a:(4  x  10-*)°).  Unfortunately,  these  devices  are  1 1.89  inches  in  diameter, 
and  mounting  them  on  the  camera  servo  would  have  been  extremely  difficult,  if  not  im¬ 
possible.  [Refs.  2:  pp.  89-111,  5] 
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Figure  3.  RVDT  Schematic:  From  Ref.  2:  p.  98. 


b.  Capacitive  Displacement  Transducers 

Angular  displacement  can  also  be  measured  by  coupling  the  rotating  com¬ 
ponent  to  the  shaft  a  of  variable  capacitor  in  the  manner  shown  in  Figure  5.  Lenk  de¬ 
scribes  the  operation  of  the  capacitive  displacement  transducer  quite  succinctly. 

The  capacitor  ...  consists  of  a  metal  plate  that  moves  between  two  fixed  metal  plates 
as  a  shaft  is  rotated.  The  three  plates,  and  the  air  between  them,  form  a  capacitor 
with  a  capacitance  that  varies  in  proportion  to  the  degree  to  which  the  plates  are 
meshed.  When  the  plates  are  completely  meshed,  the  capacitance  is  at  its  maximum. 
When  the  plates  are  completelv  unmeshed,  the  capacitance  is  at  minimum.  (Ref.  4: 

p.  181 


Capacitive  displacement  transducers  offer  many  of  the  advantages  of  reluc¬ 
tance  displacement  transducers.  They  have  an  effective  range  of  about  300®  which,  while 
better  than  the  RVDT  s  range,  is  still  not  adequate  for  the  pan  axis  [Ref.  4:  p.  18).  Ad¬ 
ditionally  they  are  more  sensitive  to  changes  in  the  ambient  temperature.  Since  the 
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Figure  4.  RVDT  Output  Characteristics:  From  Ref.  2:  p.  95. 


Figure  5.  Capacitive  Displacement  Transducer:  Ref.  4:  p.  18. 


measurement  system  was  being  designed  to  be  used  outdoors,  the  use  of  a  capacitive 
displacement  transducer  would  have  required  the  addition  of  a  temperature  compensator 
in  the  design.  While  possible,  this  would  have  increased  the  system  complexity  consid¬ 
erably.  |  Ref.  2:  pp.  90-9 1J 
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c.  Potentiometric  Displacement  Transducers 

Another  very  common  and  relatively  simple  family  of  transducers  operate 
by  measuring  the  change  in  resistance  caused  by  a  change  in  the  measurand.  There  are 
a  wide  variety  of  such  devices  available.  The  basic  form  of  potentiometric  angular  dis¬ 
placement  transducers  uses  a  resistance  element,  formed  into  an  arc,  and  a  movable 
electrical  contact  that  rotates  about  the  axis  of  interest.  By  measuring  the  change  in 
resistance  that  results  from  a  change  in  position,  one  is  able  to  determine  the  angular 
displacement.  The  resistive  element  is  typically  a  wirewound  element,  the  resolution  of 
which  is  determined  by  the  number  of  turns  per  unit  length  of  the  resistance  element. 
The  angular  resolution  can  be  increased  by  increasing  the  turn  density  (wires/degree)  of 
the  potentiometer. 

The  practical  limit  for  wire  spacing  on  wirewound  elements  according  to 
Ref.  6  is  between  500  and  1000  turns  per  inch.  From  Figure  6  one  can  see  that  this 
limits  the  angular  resolution  for  a  single-turn  device  to 

A0(rad)=  tan(  )  <» 


Therefore, 


A0(rad)=s 


2Ax  __ 
D  ~ 


0.002(in) 
D{  in) 


(2) 


To  achieve  the  10-“  rad  resolution,  specified  for  the  Pan  axis,  with  a  single  turn 
potentiometer  would  therefore  require  a  20  in  diameter  potentiometer.  Mounting  a  de¬ 
vice  this  large  on  the  camera  servo  was  simply  not  feasible.  Potentiometers  are.  how¬ 
ever,  available  with  multiple  turns.  Shaped  in  a  helix  fashion  similar  to  that  shown  in 
Figure  7,  the  total  length  of  the  potentiometer  can  be  increased,  which  in  turn  increases 
its  resolution,  without  increasing  the  diameter  of  the  device. 

Increasing  the  resolution  of  the  potentiometer  by  increasing  the  turn  density 
in  any  of  the  manners  described  above,  however,  increases  the  output  impedance  of  the 
device,  which  leads  to  increasing  nonlinearity  between  the  measurand  and  the  transducer 
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Figure  6.  Geometry  of  an  Angular  Potent iometric  Transducer 
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Figure  7.  Multiturn  Potentiometer:  From  Ref.  6:  p.  218 


output.  The  nonlinear  relationship  can  be  seen  by  analyzing  the  circuit  shown  in 
Figure  8.  In  the  diagram  the  following  variable  definitions  apply: 

•  ex  —  Input  voltage, 

•  e„  =  Output  voltage, 

•  R,  =  Total  resistance  of  the  potentiometer, 

•  Rm  =  Meter  resistance, 

•  x,  —  Total  range  of  the  potentiometer,  and 

•  x,  =  Actual  displacement  of  the  potentiometer. 

Assuming  that  R,is  uniformly  distributed  over  x„  analysis  of  the  voltage  divider  circuit 
gives, 
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Figure  8.  Potentiometric  Transducer:  From  Ref.  6:  p.  219 


Thus,  the  ideal  (i.e.,  linear  )  relationship, 


(4) 


is  true  only  when  R,.  R„  =  0,  and  since  R,  0,  and  Rm  #  oo,  the  nonlinear  relationship  in 
(3)  will  always  exist.  Doebelin  states  that  “for  values  of  R,/Rm<0.1  the  position  of 
maximum  error  occurs  in  the  neighborhood  of  xjx,  =  0.67,  and  the  maximum  error  is 
approximately  15(R,/Rm)  percent  of  full  scale.”  (Ref.  6:  p.  218]  Other  potentiometric 
transducers,  which  use  a  resistive  element  made  of  carbon  film  or  a  conducting  plastic, 
are  not  subject  to  the  same  kind  of  resolution  limitations  as  wirewound  devices;  however, 
they  do  have  high  output  impedances  and  the  corresponding  nonlinearities  described 
above.  [Ref  6-  pp.  217-224] 

A  high  quality  multitum  potentiometer  used  in  conjunction  with  a  high 
quality  voltmeter  offered  one  possible  solution  to  the  design  problem.  However,  the 
nonlinearity  of  this  arrangement  was  a  significant  disadvantage,  and  the  primary  reason 
why  potentiometers  were  not  used. 


d.  Encoders 


The  angular  displacement  transducer,  referred  to  in  general  as  an  angular 
encoder  or  shaft  encoder,  converts  an  angular  displacement  into  a  digital  signal  without 
the  use  of  an  analog-to-digital  converter.  In  today's  increasingly  digital  world  this  can 
be  a  distinct  advantage. 

There  are  three  different  transduction  methods  used  in  encoders.  Magnetic 
encoders  use  a  pattern  made  from  magnetized  and  nonmagnetized  segments  and  one  or 
more  magnetic  sensors  that  register  as  either  “I  s”  or  “0's”  depending  on  the  magnetic 
characteristics  of  the  section  that  they  are  adjacent  to.  Brush-type  encoders  are  similar, 
but  the  sections  are  made  of  conducting  and  nonconducting  materials.  The  conductors 
are  all  tied  to  a  common  source  and  the  “sensor”  is  one  or  more  brushes  connected  to 
the  output.  When  the  brush  is  in  contact  with  one  of  the  conductors  the  output  is 
"on”  and  when  the  brush  is  in  contact  with  an  insulator  the  output  is  “ofF\  Optical 
encoders  (See  Figure  9)  use  a  pattern  of  opaque  sections  marked  on  an  otherwise 
transparent  disk.  A  light  emitting  diode  (LED),  or  other  light  source,  is  placed  on  one 
side  of  the  disk,  and  as  the  disk  rotates  a  light  sensor  on  the  other  side  of  the  disk 
“sees”  periods  of  dark  and  light  which  it  converts  into  a -digital  signal.  [Ref.  2:  p.  106] 

Angular  encoders  are  further  categorized  as  either  absolute  encoders  or  in¬ 
cremental  encoders.  Absolute  encoders,  similar  to  the  optical  encoder  shown  in 
Figure  9,  use  a  multitrack  pattern  on  a  code  wheel  to  produce  a  unique  coded  output 
signal  for  each  incremental  change  in  the  measurand.  These  wheels  use  a  variety  of 
codes,  including  binary  code,  binary-coded  decimal  (BCD)  and  Gray  code,  to  determine 
the  shaft  position.  The  resolution  of  an  absolute  shaft  encoder  is  limited  by  the  number 
of  tracks  on  the  disk  and  the  type  of  code  used.  A  simple  binary  or  Gray  code  encoder, 
which  are  more  efficient  than  the  BCD  encoders,  with  N  tracks  has  an  optimum  angular 
resolution  of 


A6  = 


360° 

2n 


(5) 


Thus,  to  achieve  the  desired  resolution  of  10'4  radians  on  the  Pan  axis  with  an  absolute 
encoder  would  require  a  code  wheel  with  N  ;>  16.  Since  the  output  from  the  encoder  is 
unique  for  each  position,  these  devices  are  not  affected  by  power  outages,  and  the  re¬ 
quirements  for  a  signal  processor  for  such  a  device  would  be  limited  to  a  simple  decoding 
circuit.  These  encoders  can  measure  angles  of  up  to  360°  without  ambiguity. 
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Incremental  encoders  use  a  code  wheel  which  has  only  one  track.  As  the 
shaft  of  the  incremental  encoder  rotates  the  output  from  the  encoder  is  a  series  of 
equally  spaced  pulses.  These  pulses  can  then  be  used  as  an  input  signal  to  an  up, down 
(I'  D)  counter  of  some  sort.  The  output  from  the  counter  is  an  indication  of  the  dis¬ 
placement  of  the  axis  from  some  predetermined  reference.  The  resolution  of  an  incre¬ 
mental  encoder  is  a  function  of  the  number  of  pulses  the  code  wheel  generates  per 
revolution  and  is  given  by; 


A0  = 


360° 
n  x  PPR 


(6) 


where  PPR  is  the  number  of  pulses  per  revolution  of  the  code  wheel,  and  n  is  the  number 
of  revolutions  that  the  code  wheel  makes  per  revolution  of  the  axis  of  interest.  If  the 
incremental  shaft  encoder  was  mounted  on  the  shaft  of  interest  (n  =  1)  at  least  62,832 
PPR  would  be  required  to  ensure  a  resolution  of  10“*  radians. 


Shaft  encoders  currently  range  in  price  from  less  than  S  100.00  to  several 
thousand  dollars  depending  on  their  capabilities  and  the  method  of  transduction  used. 
Litton  Encoder's  Model  60  absolute  shaft  encoder  uses  a  natural  binary  code,  has  15 
tracks  (0.1917  mrad  resolution)  and  is  available  “off  the  shelf  for  approximately  S3000. 
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Other  absolute  encoders  with  comparable  resolutions  are  available  at  similar  prices.  No 
incremental  encoders  were  found  which  offered  the  same  kind  of  resolution  as  Litton's 
Model  60;  however,  because  they  are  not  limited  to  one  revolution  of  the  axis,  the  re¬ 
solution  of  an  incremental  encoder  can  be  improved  by  a  factor  of  n  by  causing  its  code 
wheel  to  rotate  n  times  for  every  rotation  of  the  axis  of  interest.  Incremental  encoders 
with  1024  PPR  are  available  from  a  variety  of  manufacturers  for  about  SIOO  each. 
Connecting  such  a  device  to  the  axis  of  interest  via  a  gear  train  with  a  50:1  ratio  would 
theoretically  result  (from  (6))  in  a  resolution  of  0.1227  mrad.  Incremental  encoders  do 
require  more  complex  signal  processing  than  absolute  encoders,  and  they  are  affected 
by  power  shut-off.  Additionally,  unlike  absolute  encoders,  any  missed  or  erroneous 
count  that  occurs  with  an  incremental  encoder  will  cause  a  persistent  error.  [Ref.  7: 

p.  16] 

After  considering  the  measurement  system  performance  criteria  and  the  ca¬ 
pabilities  and  limitations  of  the  various  transducers,  the  use  of  an  incremental,  optical 
shaft  encoder  appeared  to  be  the  best  selection  for  the  transducer  for  each  axis.  This 
decision  involved  balancing  the  various  advantages  and  disadvantages  of  the  different 
transducers.  The  following  list  gives  a  summary  of  the  key  considerations  in  this  deci¬ 
sion. 

•  Small,  lightweight,  highly  accurate  and  relatively  inexpensive  models  were  readily 
available.  Being  small  and  lightweight  suggested  that  mounting  and 
weatherproofing  the  transducers  in  the  camera  servo  should  not  be  too  difficult. 

•  Absolute  encoders  offer  almost  all  of  the  advantages  of  the  incremental  encoders; 
they  are  not  affected  by  power  outage,  they  require  less  complex  signal  processing 
and  one  time  counting  errors  do  not  persist.  However,  these  features  did  not  seem 
to  justify  the  additional  price  of  an  absolute  encoder. 

•  Linearity  and  loading  problems  associated  with  the  potentiometric  displacement 
transducers  were  avoided. 

•  Direct  conversion  of  the  measurand  into  a  digital  signal  precluded  the  requirement 
for  an  A  D  converter.  (This  would  have  been  a  disadvantage  had  the  use  of  an 
analog  signal  conditioner  been  anticipated.) 

•  Using  two  identical  transducers,  each  capable  of  meeting  the  specifications  for  the 
pan  axis,  would  reduce  system  complexity  while  still  ensuring  that  the  design  spec¬ 
ifications  were  met. 


C.  MOUNTING  THE  TRANSDUCER 

Once  the  decision  to  use  an  incremental  optical  shaft  encoder  was  made,  selection 
of  a  specific  model  remained.  Before  selection  of  an  actual  piece  of  hardware  could  be 
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Table  1.  ANGULAR  DISPLACEMENT  TRANSDUCERS 


TRANSDUCER 

DESIGN 

RANGE 

RESOL¬ 

UTION 

LINEAR¬ 

ITY 

OTHER 

Reluctive 

Displacement 

(RVDT) 

0C  -360° 

Theore¬ 
tically  infi¬ 
nite;  ' 

Limited  by 
the  signal 
condi¬ 
tioner. 

Poor  beyond 
±40° 

Reluctive 

Displacement 

(Farrand's 

INDLCTOSYN) 

0°  -360° 

±(4x  10-*)° 

Good 

Large  size  limits  use¬ 
fulness  with  the  cam¬ 
era  measuring 
system. 

Capacitive 

Displacement 

0°  -300° 

Theore¬ 
tically  infi¬ 
nite; 

Limited  by 
the  signal 
condi¬ 
tioner. 

Good 

Temperature  sensi¬ 
tive 

Potentiometric 

Displacement 

0°  -3500° 

Device 

dependent 

Device 

dependent 

The  trade-off  be¬ 
tween 

range,  resolution  and 
linearity  due  to  the 
loading  effect  of  the 
noninfinite 
impedance  of  the  sig¬ 
nal  conditioning  de¬ 
vices  used. 

Absolute 

Encoders 

0°  -360° 

360° 

2N 

Good 

No  A  D  conversion 
required.  Insensitive 
to  power  shut-ofT. 

Incremental 

Encoders 

±  oo 

360° 

n  x  PPR 

Good 

Simple.  Requires 
more  signal  process¬ 
ing  than  absolute  en¬ 
coder  but  is  less 
expensive. 

done  though,  one  additional  practical  consideration  had  to  be  made;  where  and  how 
could  a  transducer  be  mounted  in  or  on  the  servo  in  order  to  measure  the  position  of  the 
Pan  and  Tilt  axes? 

The  physical  layout  of  the  camera  positioning  servo  made  direct  connection  of  any 
type  of  transducer  to  the  axes  of  interest  virtually  impossible  without  major  modification 
of  the  servo  itself.  Major  modification  of  the  servo  would  have  been  expensive,  time 
consuming  and  outside  the  scope  of  this  thesis.  It  was  not  considered  an  option  in  this 
case.  Measurement  of  the  Pan  and  Tilt  axes'  displacements  was  most  readily  accom¬ 
plished  indirectly.  Each  axis  of  the  servo  is  positioned  by  a  separate  dc  motor  via  a  gear 
train.  By  mounting  the  shaft  encoder  code  wheels  to  the  sprockets  (items  42  and  43  in 
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Figure  10)  which  are  each  attached  to  one  of  the  worms,  an  indirect  measurement  of  the 
position  of  each  of  the  wormgears  (items  5  and  7  in  Figure  10)  was  possible.  This  ap¬ 
proach,  made  necessary  by  the  servo  design,  was  a  mixed  blessing. 

The  backlash  in  a  worm-wormgear  connection  will  cause  the  position  of  the  worm 
to  be  different  for  any  given  wormgear  position,  depending  cn  whether  that  position  is 
approached  from  a  clockwise  or  a  counterclockwise  direction.  In  order  to  correctly  de¬ 
termine  the  displacement  of  the  wormgear  by  measuring  the  displacement  of  the  worm, 
the  amount  of  backlash  present  must  be  known  (i.e.,  would  have  to  be  determined  ex¬ 
perimentally)  and  accounted  for  by  the  measurement  system.  This  nonlinear  source  of 
error  would  not  have  been  a  concern  if  the  servo  was  only  required  to  rotate  in  one  di¬ 
rection.  This  was  not  the  case,  however,  and  hysteresis  eventually  was  determined  to 
be  the  largest  single  source  of  error  in  the  measurement  system.  A  more  complete  dis¬ 
cussion  of  this  topic  is  included  in  Chapter  IV'  of  this  thesis. 

Assuming  for  the  moment  that  the  effects  of  the  backlash  in  the  gears  could  have 
been  completely  compensated  for,  mounting  the  shaft  encoders  on  the  worm  provided 
a  measurement  advantage  analogous  to  the  mechanical  advantage  afforded  by  the  gear 
train.  Initial  measurements  indicated  that  each  of  the  worms  turned  through  18,000° 
(50  x  360°)  for  every  360°  rotation  of  the  corresponding  wormgear.  This  meant  that  a 
shaft  encoder  with  100  divisions  per  360°  attached  to  the  worm  axis  could  do  the  same 
job  as  a  5,000  division  per  360°  encoder  attached  to  the  wormgear  axis. 

D.  SELECTING  AN  OPTICAL  SHAFT  ENCODER 

Once  the  basic  decisions  to  use  incremental  optical  shaft  encoders  and  to  mount  the 
encoders  on  the  worms  inside  the  servo  housing  had  been  made,  selection  of  the  specific 
pieces  of  hardware  was  relatively  straight  forward  and  was  primarily  a  matter  of  con¬ 
venience  and  expediency. 

Returning  to  the  design  specifications  for  a  moment;  the  most  stringent  requirement 
was  to  be  able  to  measure  the  position  of  the  pan  axis  to  within  ±  (5.73  x  lO3)0.  To 
determine  the  required  resolution  for  the  optical  shaft  encoder,  the  following  calculations 
were  performed. 

First, 


360°/Revolution  _  „„  Divisions 

- : -  2:62,827  — - - — ; — 

5.73  x  10*3°/Division  Revolution 


(7) 


Then,  considering  the  50:1  gear  advantage, 


62.827  Divisions 

“^O-*1257  Revolution  '  (8) 

The  task  therefore  was  to  find  an  optical  shaft  encoder  capable  of  detecting 
bidirectional  rotation  with  at  least  1257  Divisions/ Revolution  in  a  package  small  enough 
to  mount  in  the  servo  housing  on  the  worm  axis.  There  was  no  absolute  size  limitation; 
however,  due  to  the  construction  of  the  servo  it  was  desirable  to  find  an  encoder  that 
was  no  more  than  3  in.  in  diameter  and  no  more  than  1 .5  in.  in  width.  The  companies 
that  make  shaft  encoders  are  capable  of  custom  building  devices  to  meet  a  customer's 
specific  needs.  However,  the  prices  are  high,  and  the  lead  times  are  long  for  these  special 
order  parts.  The  encoder  for  this  system  needed  to  be  reasonably  priced  and  readily 
available  to  ensure  timely  completion  of  the  project  and  to  facilitate  replacement,  if 
necessary,  in  the  future. 

Optical  shaft  encoders  are  manufactured  by  numerous  companies  including  Litton, 
Honeywell.  BE1,  I  VO  and  Hewlett  Packard.  Sales  literature  from  these  companies  was 
reviewed  prior  to  making  a  decision  on  the  specific  shaft  encoder  model  to  be  used.  In¬ 
cremental  optical  shaft  encoders  with  resolutions  that  range  from  one  pulse  per  revo¬ 
lution  (PPR)  to  2540  PPR  are  available  off  the  shelf  from  one  or  more  of  these 
companies.  While  evaluating  sources  of  supply,  incremental  optical  shaft  encoders  were 
also  found  in  use  in  various  laboratories  and  shops  in  the  Electrical  Engineering  and 
Physics  Departments  at  ihe  NPS.  Encoders  immediately  available  from  stock  included 
two  Vernitech  1200  PPR  (model  VOE-23-1200-AI-LD5-2L1-1603-2)  encoders  from  the 
Physics  Department  and  two  Hewlett  Packard  (HEDS-6000  J06)  encoders  from  the 
Electrical  Engineering  Department.  The  use  of  the  Vernitech  encoders  was  ruled  out 
because  they  were  unable  to  detect  bidirectional  movement  without  increasing  the  com¬ 
plexity  of  the  signal  conditioning  subsystem.  Additionally,  technical  literature  requested 
on  two  separate  occasions  from  Vernitech  was  never  received. 

The  HEDS-6000  J06  encoders  have  a  resolution  of  1024  PPR.  Each  encoder  pro¬ 
vides  displacement  information  in  the  form  of  TTL  logic  level  signals  via  two  output 
channels.  When  the  encoder  is  properly  adjusted  the  two  output  signals  have  a  90° 
phase  difference.  This  quadrature  phase  relationship  permits  these  encoders  to  detect 
bidirectional  displacements.  Rotation  in  one  direction  will  cause  Channel  A  to  lead 
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Channel  B  (in  phase),  while  rotation  in  the  other  direction  will  cause  Channel  B  to  lead 
Channel  A,  [Ref.  9:  p.  2] 

The  presence  of  two  output  channels  in  quadrature  phase  has  an  additional  benefit 
that  is  useful  in  some  applications.  Since  the  amount  of  position  information  has  es¬ 
sentially  been  doubled,  if  the  signal  conditioner  is  designed  to  detect  both  the  leading  and 
trailing  edges  of  one  of  the  output  channels  the  resolution  of  the  measurement  system 
can  be  doubled.  The  difficulty  with  using  this  technique  is  that  multiple  oscillations 
about  a  single  point  cannot  be  detected  as  such.  If  the  camera  were  to  oscillate  less  than 
one  half  of  a  pulse  width  about  a  transition  the  signal  conditioner  would  detect  and  er¬ 
roneously  count  the  multiple  transitions.  [Ref.  7:  pp.  13-16) 

With  1024  PPR,  which  is  less  than  the  1257  PPR  required  to  meet  the  0. 1  milliradian 
accuracy  specification  on  the  pan  axis,  the  maximum  resolution  available,  if  the 
HEDS-6000  was  attached  to  the  worm,  can  be  calculated  as; 

(50x1o24)=(7-03l25xl0~3>,PuUe~‘-  ,9> 

Although  this  was  not  sufficient  to  satisfy  the  pan  axis  resolution  specification  of 
(5.73  x  10-3)°Pulse,-’  all  of  the  other  performance  criteria  could  be  satisfied.  The  trade¬ 
off  seemed  reasonable  and  was  approved  prior  to  proceeding  further  with  the  system 
design. 

E.  THE  DISPLAY 

Selecting  a  method  to  display  the  final  system  output  was  certainly  the  least  de¬ 
manding  task  required  in  the  design  of  the  system.  With  an  expected  resolution  on  the 
pan  axis  of  approximately  0.U070  over  a  range  of  360°  (a  ratio  of  about  1:51.500)  an 
analog  display  seemed  out  of  the  question.  A  five  or  six  digit  digital  display  on  the  other 
hand  offered  a  simple,  reliable  and  cost  efficient  means  of  presenting  the  output.  Con¬ 
structing  the  displays  from  individual,  seven-segment,  common  anode,  LED  devices,  and 
the  appropriate  display  drivers  was  a  straight  forward  task. 

F.  THE  SIGNAL  CONDITIONER 

Anticipating  the  use  of  two  incremental  shaft  encoders  as  the  transducers  for  the 
measurement  system  and  the  use  of  digital  readouts  as  the  display  devices  significantly- 
reduced  the  number  of  possibilities  for  the  signal  conditioning  subsystem.  In  addition 
to  the  hardware  and  software  described  in  each  of  the  subsequent  discussions,  each 
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technique  listed  here  would  require  an  edge  detector  to  detect  the  transitions  in  the  TTL 
signals  from  the  shaft  encoders. 

•  Up  down  counter  with  table  look-up. 

•  Up  down  counter  and  multiplication. 

•  Add  subtract. 

•  Microcomputer. 

•  Microprocessor. 

1.  Up/down  (U/D)  counter  with  table  look-up 

This  technique  would  involve  the  use  of  a  shift  register,  some  associated  logic, 
an  U/D  counter  and  a  table  look-up  device  such  as  an  erasable  programmable  read  only 
memory  (EPROM).  The  shift  register  would  serve  as  a  hardware  buffer  that  could  be 
used  to  account  for  the  hysteresis  introduced  by  the  worm-wormgear  assembly.  The 
length  of  the  buffer  would  have  to  be  determined  experimentally.  The  logic  associated 
with  the  shift  register  would  determine  the  “validity”  of  each  transition  (count)  signal 
from  the  edge  detector  by  checking  the  contents  of  the  shift  register  and  comparing  the 
current  direction  of  rotation  with  the  previous  direction  of  rotation.  Whenever  the  logic 
detected  a  change  in  rotation  direction,  or  a  partially  full,  or  a  partially  empty  buffer 
(depending  on  the  direction  of  rotation),  the  transition  would  not  represent  a  “valid” 
count  since  any  of  these  conditions  would  indicate  that  the  transition  was  due  to  a 
change  in  the  position  of  the  worm  without  a  corresponding  change  in  the  position  of 
the  wormgear.  Thus,  the  present  transition  w'ould  be  the  result  of  hysteresis  due  to  the 
backlash  in  the  gear  train  and  the  transition  would  be  “invalid”.  Such  a  transition  would 
cause  the  contents  of  the  hysteresis  buffer  to  be  modified  appropriately.  A  more  com¬ 
plete  discussion  of  this  topic  is  contained  in  Chapter  IV.  The  shift  register  and  associ¬ 
ated  logic  could  be  built  from  common  TTL  devices  readily  available  at  the  NPS. 

Once  a  count  had  been  determined  to  be  valid,  an  U/D  counter  wrould  be  used 
to  keep  a  running  total  of  the  number  of  counts.  Again,  such  a  device  could  be  built 
using  readily  available  TTL  devices  such  as  the  74LS168A,  Synchronous  4-Bit  Up/Down 
Decade  Counter,  or  the  74LS169A,  Synchronous  4-Bit  Up  Down  Binary  Counter.  The 
output  from  the  U/D  counter  would  then  be  used  as  an  address  to  “look  up”  a  prede¬ 
termined  number  stored  in  an  EPROM. 

This  design  approach  was  considered  relatively  straightforward,  and  at  least  in¬ 
itially  seemed  like  a  viable  option.  Its  major  advantage  was  that  it  was  conceptually 
quite  simple.  This  simplicity  had  a  price  though;  it  would  have  been  very  hardware  in- 
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tensive  and  consequently  would  have  been  a  very  inflexible  design.  For  example,  if  at  a 
later  date  the  use  of  an  arbitrary  reference  was  desired,  additional  hardware  would  have 
to  be  added  to  the  signal  conditioner  so  that  the  counter  could  be  initialized  to  the  ar¬ 
bitrary  starting  point.  Since  all  of  the  processing  would  have  to  be  done  in  hardware, 
even  a  minor  modification  in  the  system  could  necessitate  a  major  design  revision.  An¬ 
other  consideration  was  that  saving  in  excess  of  51,000  unique  positions  in  the  EPROM 
presented  a  nontrivial  problem  that  would  need  to  be  solved  if  this  technique  was  used. 

2.  Up/down  counter  and  multiplication 

This  is  very  similar  to  the  previous  case,  differing  only  in  that  instead  of  looking 
up  a  predetermined  position,  in  a  memory  device,  a  multiplier  would  be  used  to  multiply 
the  output  of  the  U,  D  counter  by  a  predetermined  constant.  As  an  example,  if  exper¬ 
imental  results  indicated  that  the  shaft  encoders  generated  one  pulse  for  every 
0.00703125°  that  the  camera  was  displaced,  then  each  time  a  valid  count  was  received, 
the  updated  count  would  need  to  be  multiplied  by  0.00703125  in  the  final  stage  of  the 
signal  processor.  The  result  would  be  the  new  position.  Again,  while  conceptually 
simple  this  idea  had  some  significant  disadvantages.  Even  more  hardware  intensive  than 
the  first  approach,  this  design  would  also  have  extremely  limited  flexibility. 

Accomplishing  the  multiplication  would  have  posed  a  formidable  task.  The 
scale  factor  would  have  to  be  written  as  some  integer  (e.g.,  0.00703125  would  become 
703125,  or  70323,  or  7031,  etc.)  depending  on  the  desired  accuracy.  The  count,  already 
an  integer,  would  be  multiplied  by  the  constant  and  the  correct  position  of  the  decimal 
point  would  have  to  be  determined.  Locating  the  decimal  point  would  be  a  relatively 
simple  task,  but  multiplication  of  two  numbers  such  as  51,000  and  70,313  would  not  be 
as  easy.  At  least  one  16  bit  by  16  bit  binary  multiplier  (i.e.,  TRW's  MPY016H)  is  cur¬ 
rently  available,  but  since  the  number  70313  cannot  be  represented  in  binary  by  less  than 
17  bits,  the  multiplication  could  have  been  accomplished  in  either  of  two  ways.  One 
solution  would  have  been  to  perform  the  multiplication  in  two  or  more  stages.  Alter¬ 
natively,  70313  could  be  “rounded”  to  7031.  The  second  option  would  create  a  cumu¬ 
lative  round-off  of  about  (1.28  x  10'3)°  per  360°  rotation  (assuming  51,200  pulses  per 
360°  ).  This  round-off  error  would  probably  have  been  acceptable,  but  the  complexity 
and  limited  flexibility  of  either  multiplication  scheme  made  the  U.'D  counter  and  multi¬ 
plication  an  unacceptable  candidate  for  the  signal  processing  subsystem. 

3.  Add/subtract 

A  third  design  concept  considered  the  elimination  of  the  U'D  counter  alto¬ 
gether.  The  same  logic  proposed  for  use  in  the  previous  two  designs  could  have  been 
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used  to  check  the  validity  of  a  count  and  to  determine  the  direction  of  rotation.  How¬ 
ever,  instead  of  valid  counts  being  sent  to  an  U/D  counter  as  before,  these  counts  would 
now  signal  an  adder  to  add  or  subtract  a  predetermined  constant  from  the  running  total. 
Just  as  before,  this  simple  idea  could  probably  have  been  made  to  work  at  least  once, 
but  its  usefulness  as  a  part  of  a  larger  system  would  certainly  have  been  limited.  The 
large  number  of  components  required  to  realize  this  design  would  have  increased  the 
probability  of  failure,  complicated  troubleshooting  and  reduced  overall  flexibility. 

4.  Microcomputer 

If  the  signal  processing  subsystem  was  built  around  a  microcomputer  (PC),  vir¬ 
tually  all  of  the  disadvantages  associated  with  the  previously  discussed  approaches  would 
be  eliminated.  Since  all  of  the  logic  could  be  implemented  in  software,  modifications  to 
the  system  would  be  relatively  simple  to  make,  and  the  system's  flexibility  would  be  en¬ 
hanced.  However,  dedicating  a  microcomputer,  even  an  inexpensive  model,  to  the  signal 
processing  tasks  for  this  measurement  system  was  considered  overkill,  and  timesharing 
with  one  of  the  PC's  already  in  twice  was  possible,  but  not  considered  practical  or 
convenient  since  these  microcomputers  had  already  been  dedicated  to  a  variety  of  tasks. 

5.  Microprocessor 

One  final  option  for  the  signal  processor  remained.  Microprocessors  are  rela¬ 
tively  inexpensive  and  powerful  and  are  available  in  a  wide  variety  of  makes  and  models. 
If  a  microprocessor  was  used  instead  of  a  microcomputer  or  a  straight  hardware 
processor,  the  “nice  to  have”  requirements  such  as  flexibility,  ease  of  modification  and 
capacity  for  expansion,  as  well  as  the  required  signal  processing  functions  could  all  be 
satisfied.  On  the  other  hand,  microprocessors  have  one  distinct  disadvantage;  they  are 
not  user  friendly.  The  use  of  a  microprocessor  implied  countless  hours  spent  tracking 
individual  bits,  debugging  assembly  language  code,  studying  timing  diagrams,  etc..  No 
matter  how  distasteful  the  thought,  however,  a  microprocessor  was  clearly  the  best  way 
to  perform  the  signal  processing  functions  of  the  measurement  system. 

As  with  the  selection  of  the  transducer,  once  the  basic  design  approach  had  been 
determined,  selection  of  a  specific  device  was  a  relatively  straight  forward  task.  The 
choice  of  one  microprocessor  over  another  was  a  function  of  the  processor's  ability  to 
perform  the  required  tasks,  cost  effectiveness  and  availability.  Motorola's  MC68705U3 
seemed  to  satisfy  all  of  these  requirements.  The  MC68705U3  is  a  four  kilobyte  EPROM 
microprocessor,  built  using  HMOS  (high-density  NMOS)  technology  with  an  eight  bit 
architecture.  The  “68705”  operates  on  a  5.0  volt  dc  supply,  has  112  bytes  of  on  chip 
RAM,  four  vectored  interrupts,  24  TTL/CMOS  compatible  bidirectional  I/O  lines  (eight 
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lines  are  LED  compatible),  eight  dedicated  input  lines  and  an  internal  eight  bit  timer 
with  a  seven  bit  programmable  prescaler.  [Ref.  10:  p.  1] 

In  Ref.  10  Motorola  advertises  the  following  software  features: 

•  Programming  language  similar  to  the  6800  family. 

•  Byte  efficient  instruction  set. 

•  Easy  to  program. 

•  True  bit  manipulation. 

•  Bit  test  and  branch  instructions. 

•  Versatile  interrupt  handling. 

•  Powerful  indexed  addressing  for  tables. 

•  Versatile  index  register. 

•  A  full  set  of  conditional  branches. 

•  Memory  usable  as  registers/flags. 

•  Single  instruction  memory  examine/change  capability. 

•  Ten  powerful  addressing  modes. 

•  All  addressing  modes  apply  to  EPROM,  RAM  and  I/O. 

One  key  advantage  to  using  the  MC68705U3  was  that  one  of  the  micro¬ 
processors,  and  a  Motorola  M68705EVM  (the  evaluation/ programming  module  for  the 
M6805  family  of  devices)  were  both  available  for  immediate  use  at  the  NPS.  The  fact 
that  the  68705  utilized  HMOS  technology  suggested  that  it  should  be  a  relatively  low 
cost  microprocessor.  In  fact,  except  for  the  price  of  a  phone  call,  a  second  micro¬ 
processor  was  obtained  free  of  charge  from  a  local  electronics  ■wholesaler.  Additional 
microprocessors,  to  be  used  as  replacements  and  as  backup  devices  were  ordered  for 
about  S20.00  each. 

One  potential  problem  with  using  a  microprocessor  begged  checking  prior  to 
proceeding.  Initial  measurements  of  the  camera's  maximum  rotation  velocity  produced 
the  following  results. 


'pan  { ma*)  —  L0  rpm 

(10) 

TILT(  max)  ~  °-5  1?™ 

(11) 

Again  the  requirements  for  the  pan  axis  presented  the  most  stringent  design  limitations. 
Since  the  optical  shaft  encoders  were  anticipated  to  deliver  51,200  PPR  (  1024  x  50)  the 
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microprocessor  on  the  pan  axis  had  to  be  capable  of  processing  51,200  pulses/ minute 
(1.172  ms  /  pulse).  The  MC68705U3  is  designed  to  operate  with  an  oscillator  frequency 
( fse )  of  between  0.4  MHz  and  4.4  MHz  and  has  an  instruction  cycle  time  (4//0!C)  of  be¬ 
tween  0.950  ix s  and  10  /xs.  Assuming  that  a  4.0  MHz  clock  was  used,  the  instruction 
cycle  time  would  be  1.0  ns.  This  would  mean  that  the  processing  of  each  pulse  would 
have  to  be  accomplished  in  no  more  than  1172  instruction  cycles  to  ensure  that  no  pulses 
would  be  missed. 


III.  DESIGN 


A.  GENERAL 

The  schematic  diagrams  for  the  measurement  system  are  shown  in  Appendix  A; 
Appendix  B  contains  copies  of  the  printed  circuit  board  plans.  Before  describing  the 
detailed  operation  of  each  of  the  individual  components  of  the  measurement  system,  a 
brief  overview  of  its  basic  theory  of  operation  is  in  order.  The  measurement  system  is 
actually  two  separate  systems  operating  independently.  The  system  designed  to  measure 
the  azimuth  or  pan  angle  will  subsequently  be  referred  to  as  the  “Pan  System”,  and  the 
other  system,  designed  to  measure  the  elevation  or  tilt  angle,  will  be  referred  to  as  the 
“Tilt  System”.  However,  because  the  two  systems  are  quite  similar  the  discussion  which 
follows  will  only  specifically  describe  the  operation  of  both  systems  where  their  opera¬ 
tion  differs. 

In  the  most  general  terms,  the  measurement  system  shown  in  Figure  2  on  page  6 
uses  two  microprocessors  to  count  the  pulses  generated  by  the  incremental  shaft  encod¬ 
ers,  and  to  provide  output  signals  to  the  display  devices.  The  counting  function  per¬ 
formed  by  each  microprocessor  involves  determining  the  direction  of  rotation  and 
determining  whether  each  count  is  “valid”.  Valid  counts  are  encoder  pulses  which  result 
from  the  displacement  of  the  camera  servo,  while  invalid  counts  are  a  result  of  the 
hysteresis  in  the  gear  train.  The  number  of  valid  counts  is  directly  proportional  to  the 
angular  displacement  of  the  camera  axis. 

Both  of  the  displays  are  capable  of  presenting  the  position  information  in  two  basic 
forms.  In  the  Count  Mode  they  display  the  number  of  pulses  that  have  been  detected, 
and  in  the  Position  Mode  they  display  the  angle  in  degrees  that  the  number  of  pulses 
represents.  A  third  display  mode,  which  is  a  combination  of  the  first  two,  is  also  avail¬ 
able.  In  the  third  mode,  referred  to  as  the  “Blinking  Mode”,  the  display  will  alternately 
display  the  count  and  the  angle. 

B.  SHAFT  ENCODER  AND  LINE  DRIVER 

Figure  1 1  shows  the  basic  components  of  the  HEDS-6000  incremental  optical  shaft 
encoder.  The  encoder  is  approximately  56  mm  in  diameter  and  20  mm  deep.  The  code 
wheel  assemblies  for  the  HEDS-6000  J06  encoders  are  designed  to  mount  on  0.25  in. 
shafts.  Since  the  mounting  surface  shown  in  Figure  1 1  is  not  part  of  the  encoder  kit, 
and  did  not  existed  on  either  of  the  worm  axes,  two  such  surfaces  were  machined  in  the 
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Physics  Department  Shop  and  attached  to  one  end  of  each  of  the  worms.  Each  surface 
has  a  0.25  in.  diameter  shaft  to  which  one  of  the  code  wheel  assemblies  is  attached.  Two 
sheet  metal  brackets,  also  made  in  the  Physics  Department  Shop,  are  bolted  to  the  servo 
frame.  The  encoder  bodies  are  mounted  to  these  brackets.  Figure  12  shows  the  shaft 
encoders  mounted  in  the  camera  servo.  [Ref.  9:  p.lj 


EMITTER  CODE  WHEEL  fHASE  ENCODER  MOUNTING 

END  PLATE  ASSEMBLY  PLATE  BODY  SURFACE 


Figure  11.  HEDS-6000  Series  Encoder  Kit:  From  Ref  9:  p.6. 

Also  seen  in  Figure  12  is  a  printed  circuit  board  mounted  between  the  two  optical 
shaft  encoders.  Each  of  the  encoders  is  electrically  connected  to  the  board  via  a  separate 
ten  wire  ribbon  cable.  The  power  and  the  output  signals  from  the  shaft  encoders  are 
transmitted  through  these  cables.  A  sketch  of  the  ribbon  cable  connector  and  the  pinout 
for  the  connector  are  shown  in  Figure  13.  Each  connector  is  attached  to  a  ten  pin 
header  on  the  printed  circuit  board.  Pins  2,  7  and  9  are  connected  to  a  +5.0  Vdc  power 
supply  external  to  the  camera  servo.  A  description  of  the  power  supply  is  given  later  in 
this  chapter.  Pins  3,  4,  5  and  6  are  connected  to  the  power  supply  ground.  The 
HEDS-6000  does  not  have  an  index  pulse,  therefore  pin  10  is  not  connected. 

The  remaining  two  pins  on  each  header  connect  the  output  channels  of  the  shaft 
encoders  to  two  74S140  line  drivers.  Each  74S140  is  a  dual  four-input  NAND  gate 
50-Ohm  line  driver.  The  line  drivers  are  powered  by  the  same  supply  as  the  encoders. 
They  serve  as  buffers  between  the  encoders  and  the  transmission  lines  which  are  used  to 
transmit  the  encoder  signals  to  the  signal  conditioner.  The  line  drivers'  typical  high 
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Figyrc  12.  Modified  Camera  Servo:  (a)  Optical  shaft  encoder  used  to  measure 
Pan  axis  displacement,  (b)  Optical  shaft  encoder  used  to  measure  l  ilt 
axis  displacement,  (c)  Ribbon  cable,  (d)  Printed  circuit  board. 


output  current  is  10  mA  and  the  maximum  is  18  mA.  Resistance  in  the  transmission 
line  was  measured  to  be  approximately  35  £2,  and  to  be  on  the  safe  side  a  10  £2  con¬ 
nector  loss  was  assumed.  T  he  voltage  drop  due  to  an  18  mA  current  through  a  45  £2 
resistance  is  0.81  V.  A  "voltage  high”  signal  received  at  the  signal  conditioner  should 
therefore  be  about  4.19  V.  This  is  well  above  the  maximum,  positive-going  threshold 
voltage  specification  of  2.0  V  for  the  7414  Schmitt  triggers,  which  are  used  to  receive  the 
signals  at  the  signal  processor.  [Ref.  1 1:  pp,  5-73,  5-74,  6-44) 

C.  ENCODER-MICROPROCESSOR  INTERFACE 

I  he  signals  transmitted  by  the  two  line  drivers  are  Channels  A  and  B  of  each  of  the 
shaft  encoders.  These  signals  contain  the  raw  data  which  the  signal  processor  converts 
into  position  information.  Three  pairs  of  multiple  pin  connectors  are  used  in  the 
euvodcr-microproccssor  interlace.  Ihe  pinouts  for  these  connectors  arc  shown  in 
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PINOUT 


PIN  ■  P UNCTION 

1  CHANNEL A 

*  Vce 

J  GROUND 
4  N.C.  OR  GROUND 

B  N.C.  OR  GROUND 

*  GROUND 

7  Vcc 

I  CHANNEL  I 

*  vec 

tO  CHANNEL  I 


Figure  13.  Encoder  Connector  Specifications:  From  Ref.  9:  p.  6. 

Figure  14.  Each  of  the  four  signals  is  received  at  the  signal  processor  by  a  7414  Schmitt 
trigger  which  is  used  to  “clean  up"  the  signal.  The  Schmitt  triggers  lower  the  system's 
susceptibility  to  errors  caused  by  slow  state  transitions  and  increase  the  signals'  fan  out 
capabilities  [Ref.  7:  p.  13]. 

The  output  of  each  Schmitt  trigger  is  routed  to  an  input  port  of  the  appropriate 
microprocessor.  Each  Channel  A  signal  is  also  the  input  to  an  edge  detector.  The  edge 
detectors  each  consist  of  three  7414  inverters,  a  74LSS6  EXOR  gate  and  a  47  nF 
capacitor,  configured  in  the  manner  shown  in  Figure  15.  This  configuration  causes  the 
interrupt  line  to  go  low  for  approximately  2  ms  each  time  Channel  A  transitions  from 
low  to  high  or  from  high  to  low.  Since  an  oscillator  frequency,  f„c,  of  4.0  MHz  is  being 
used,  the  interrupt  pulse  width,  tKX,  must  be  greater  than  or  equal  to  1.25  ms  [Ref.  10: 
p.  3].  The  value  of  the  capacitor  required  to  achieve  the  2  ms  delay  was  determined  ex¬ 
perimentally. 

D.  SWITCHES 

The  measurement  system  has  10  switches  that  allow  the  operator  to  control  specific 
functions  of  the  signal  processors  and  the  displays.  Figure  16  shows  the  physical  lo¬ 
cation  of  these  switches  on  the  control  panel.  Switches  SW1(P)  and  SWI(T)  control  the 
reset  lines  to  the  microprocessors.  Switches  SW2(P),  SW2(T)  and  SW5  control  the  dis¬ 
play  mode.  The  Function  and  Set  switches;  (S\V3(P),  SW3(T),  SW4(P)  and  SW4(T)) 
allow  the  user  to  change  the  length  of  the  hysteresis  buffer  in  the  microprocessor.  The 


31 


SERVO 


cm  a  J  I — I  "  I  I  L 

-  _ i  i _ n _ i — 1_ 

c“  TTrr^rTT 

-  jnjnj^jnLnLni 


Figure  15.  Interrupt  Interface:  After  Ref  7:  p.  14. 

master  power  switch  is  SW6.  Table  2  identifies  the  switches  by  name,  description  and 
function. 

Any  mechanical  switch  will  “bounce’’  or  “chatter”  when  it  is  thrown,  and  since  the 
operation  of  the  signal  processor  depends  on  the  number  of  times  that  the  Display  Mode 
and  Set  switches  change  position,  these  switches  had  to  be  “dcbounced”.  A  very  simple 
but  effective  way  to  do  this  is  with  an  RS  latch.  Switches  SW2(P),  SW2(T),  SW4(P)  and 
SW4(T)  are  each  debounced  in  this  manner.  Each  latch  is  made  from  two  74S00  NAND 
gates  connected  in  the  manner  shown  in  Figure  17.  [Refs.  13:  pp.  132-135,  12  :  pp.  3,4] 
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E.  MC68705U3 
1.  General 

The  two  40  pin  MC6S705U3  microprocessors  (MPU's)  are  the  heart  of  the 
measurement  system.  With  the  exception  of  the  light  test  signal,  every  signal  in  the 
system  is  either  part  of  the  input  to  one  of  the  MPU's  or  part  of  their  output.  The 
MPU's  were  programmed  using  the  assembly  language  syntax,  assembler  directives  and 
instruction  set  for  the  M 680.5  family  of  microprocessors  which  are  described  in  Ref.  14. 
The  Pan  and  Tilt  programs  are  listed  and  their  operation  is  described  in  Appendix  D. 
The  pin  assignments  for  the  MC6S705U3  are  shown  in  Figure  18.  Table  3  briefly  de¬ 
scribes  the  purpose  of  each  pin  and  the  actual  connections  for  the  two  MPU's. 
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2.  Memory  Map 

a.  Input  I  Output  (I/O) 

The  memory  map  for  the  MC68705U3  is  shown  in  Figure  19.  The  digits 
following  a  “S”  are  the  hexadecimal  representation  of  the  address  for  a  specific  memory 
location.  The  data  registers  occupy  the  first  four  memory  locations  of  each  MPU.  Thus 
the  information  written  into  the  registers  at  SOOO,  S001  and  S002  is  written  to  the  output 
ports  A,  B  and  C  respectively.  Port  D,  at  address  S003,  is  an  input  only  port  as  indicated 
in  Table  3.  In  order  to  determine  the  state  of  the  input  lines,  the  contents  of  the  register 
at  S003  must  be  read  by  the  MPU.  Registers  S004,  S005  and  S006  are  the  data  direction 
registers  (DDR's)  for  Ports  A,  B  and  C  respectively.  Because  all  three  ports  are  used  as 
“output  only”  ports,  in  this  application,  the  DDR's  are  all  established  as  such  by  an 
initialization  routine  performed  by  the  MPU's  during  their  initial  power-up  and  after 
each  external  reset.  [Ref.  10:  pp.  5,  12,  14) 

Pin  18  of  the  MPU  can  be  used  as  either  a  general  purpose  input  line  or  as 
an  interrupt  line.  The  primary  interrupt  line  on  each  MPU  is  used  to  signal  the  occur¬ 
rence  of  a  state  transition  on  Channel  A.  Pin  18  is  used  as  a  second  interrupt  line  to 
signal  a  display  mode  change  request  from  the  operator.  The  Miscellaneous  Register 
(MR)  at  address  SOA  is  used  to  control  the  operation  of  the  second  interrupt  line 
(IXT2) .  In  order  to  establish  pin  18  as  an  interrupt  line,  bit  6  of  the  MR  is  cleared  by 
the  Initialization  Routine.  The  1XT2  Interrupt  Request  Bit,  bit  7  of  the  MR,  is  cleared 
by  default  upon  reset.  It  is  set  when  a  falling  edge  is  detected  on  the  Display  Mode  line 
which  is  connected  to  pin  18.  When  this  occurs  and  bit  6  of  the  MR  is  cleared,  an  in¬ 
terrupt  request  is  generated.  This  interrupt  request  causes  the  display  mode  to  change. 
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Table  2.  SIGNAL  PROCESSOR  AND  DISPLAY  SWITCHES 


NAME 

DESCRIPTION  AND  FUNCTION 

PAN  RESET 
(SW1(P» 

Momentary  action  push  button  switch:  Resets  the  Pan 
Microprocessor.  Causes  the  Pan  Display  to  be  reset  to 
zero. 

TILT  RESET 
(SWI(T)) 

Same  as  SW1(P)  except  it  affects  the  Tilt  System  only. 

PAN  DISPLAY  MODE 
(SW2(P)) 

Single  pole  double  throw  toggle  switch:  Each  time  the 
switch  position  is  changed  the  Pan  Display  toggles  from 
Count  mode,  to  Position  Mode,  to  Blinking  Mode,  to 
Count  Mode,  etc.. 

TILT  DISPLAY  MODE 
(SW2(T)) 

Same  as  SW2(P)  except  it  affects  the  Tilt  Display  only. 

FUNCTION 

(HYSTERESIS) 

(SW3(P)) 

Single  pole  double  throw  switch:  When  closed,  causes 
the  “Function”  line  of  the  Pan  Microprocessor  to  go 
low  and  causes  the  size  of  the  hysteresis  buffer  to  be 
displayed  on  the  Pan  Display.  Enables  SW4(P). 

FUNCTION 

(HYSTERESIS) 

(SW3(T)) 

Same  as  SW3(P)  except  it  affects  the  Tilt  System  only. 

SET  HYSTERESIS 
(SW4(P)) 

Single  pole  double  throw  switch:  Inoperable  unless 
SW3(P)  is  closed.  If  SW3(P)  is  closed,  each  time  the 
position  of  SW4(P)  is  changed  the  length  of  the 
hysteresis  buffer  is  incremented  by  one.  Maximum 
buffer  length  is  25.  Toggling  SW4(P)  when  the  buffer 
length  is  25  will  cause  the  buffer  length  to  be  reset  to 
zero. 

SET  HYSTERESIS 
(SW4(T)) 

Same  as  SW4(P)  except  it  affects  the  Tilt  Hysteresis 
buffer. 

LIGHT  TEST 
(SW5) 

Single  pole  single  throw  switch:  When  closed,  lines  1, 

2,  7,  8,  10,  11  and  13  on  each  of  the  LED  displays  will 
go  lowr.  Unless  an  element  is  burned  out,  every  digit  in 
both  displays  should  be  an  eight. 

POWER 

(SW6) 

Single  pole  single  throw'  switch:  When  closed,  applies 
+  5.0  V  dc  power  to  the  signal  processors  and  the  dis¬ 
plays. 
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Figure  18.  MC68705U3  Pin  assignments:  From  Ref.  10:  p.  1. 


Once  bit  7  has  been  set  by  an  interrupt,  it  must  be  cleared  by  software  to  avoid  repeated 
and  unwanted  interrupts  from  occurring.  This  task  is  performed  by  the  Mode  Change 
Routine  in  each  EPROM.  (Ref.  10:  pp.  1,  10,  13,  15J 
b.  Timer 

The  operator  can  cause  either  or  both  of  the  displays  to  “blink”  by  using 
the  Display  Mode  Switches,  SW2(P)  and  SW2(T).  When  one  of  the  systems  has  its 
display  in  the  Blinking  Mode,  the  associated  MPU  uses  its  timer  to  generate  a  timer  in¬ 
terrupt  request  every  second.  The  interrupt  request  causes  the  MPU  to  execute  the 
Mode  Change  Routine.  A  block  diagram  of  the  timer  is  shown  in  Figure  20.  The  timer 
consists  of  an  eight-bit  counter  which  is  decremented  toward  zero  by  the  fcw  input. 
When  the  counter  reaches  zero,  it  sets  the  Timer  Interrupt  Request  Bit  (T1R)  of  the 
Timer  Control  Register  (TCR),  and  a  timer  interrupt  request  is  generated  unless  the 
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Timer  Interrupt  Mask  Bit  (TIM)  of  the  I  CR  is  set.  A  brief  description  of  each  of  the 
timer  registers  and  their  configuration  follows. 

(!)  Timer  Data  Register  ( TDR ).  The  I  DR  is  the  eight-bit  counter 
which  sets  the  HR  bit  of  the  I  CR  when  it  decrements  to  zero. 

(2)  Timer  Control  Register.  The  contents  of  the  ICR  determine  the 
general  operation  of  the  timer. 

•  Bit  7,  Timer  Interrupt  Request  (TIR),  signals  a  TDR  undcrllow  when  it  is  set  and 
will  cause  a  timer  interrupt  request  if  the  TIM  bit  of  the  ICR  is  clear.  The  TIR 
is  cleared  by  the  MPU  reset  or  by  program  control. 

•  Bit  6,  Timer  Interrupt  Mask  (TIM),  inhibits  a  timer  interrupt  request  when  it  is  set. 
It  is  set  by  external  reset  or  program  control  to  inhibit  the  Blinking  Mode,  and  is 
cleared  by  software  when  the  Blinking  Mode  is  requested  by  the  operator. 

•  Bit  5,  External  or  Internal  Clock  Select  (TIN),  is  used  to  select  the  timer  clock 
source.  Since  the  internal  clock  is  used  in  this  application,  the  TIN  bits  of  both 


38 


Table  3.  MPU  CONNECTIONS 


Pin 

Name 

Description 

1 

V5s 

Ground 

2 

RESET 

When  RESET  is  pulled  low  program  execution  halts,  all  variables  are 
reinitialized  and  the  Pan  display  is  set  to  zero.  SWl(P)  controls  the 
RESET  line  on  the  Pan  MPL:. 

3 

1NT 

Allows  asynchronous  interruption  of  the  processor.  When  INT  is 
pulled  low  by  the  Count  Edge  Detector  the  MPU  executes  the 
“Count  Routine”. 

H 

VCc 

+  5  V  dc  power  connection. 

5 

EXTAL 

External  clock  input.  Connected  to  a  4.0  MHz  external  clock  which 
provides  the  MPU  system  clock. 

6 

XTAL 

Crystal  clock  input.  Connected  to  ground  since  an  external  clock  is 
used. 

■ 

\PP 

Programming  voltage  pin.  Connected  to  Vcc  for  normal  operation. 

8 

Timer 

External  timer  control  input.  Connected  to  Vcc  since  the  internal 
timer  is  used. 

Port  C 

General  Purpose  1  O  lines. 

9 

PCO 

The  two  least  significant  digits  in  the  display  are  represented  in  bi¬ 
nary  coded  decimal  (BCD)  by  these  eight  lines. 

10 

PCI 

11 

PC2 

12 

PC  3 

13 

PC4 

14 

PC5 

15 

PC6 

16 

PC7 

Port  D 

General  Purpose  input  lines. 

17 

PD7 

PD7  is  the  Channel  A  input  to  the  MPU. 

PD6  is  used  as  a  second  interrupt  line. 

When  PD6  goes  low  the  MPU  changes  display  modes. 

PD5  is  the  Channel  B  input  into  the  MPU. 

PD4  is  the  Function  input  into  the  MPU. 

PD3  is  the  Set  input  into  the  MPU. 

PD2-PD0  are  not  used  and  are  tied  to  ground. 

18 

PD6 

INT2 

19 

PD5 

20 

PD4 

21 

PD3 

22 

PD2 

23 

PD1 

24 

PDO 
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Table  4.  MPU  CONNECTIONS  (CONPD.) 


Pin 

Name 

Description 

Port  B 

General  Purpose  I/O  lines  (LED  compatible). 

25 

PB0 

The  most  significant  digit  is  represented  in  BCD  by  PB0-PB3  except 
on  the  Tilt  MPU  where  these  lines  are  connected  to  ground. 

PB4  determines  which  digits  in  the  display  are  blanked. 

PB5  is  not  used.  Connected  to  ground. 

PB6  determines  the  presence  or  absence  of  the  display  minus  sign. 

PB7  determines  the  presence  or  absence  of  the  display  decimal  point. 

26 

PB1 

27 

PB2 

28 

PB3 

29 

PB4 

30 

PB5 

31 

PB6 

32 

PB7 

Port  A 

General  Purpose  1,0  lines. 

33 

PA0 

The  third  and  fourth  least  significant  digits  are  represented  in  BCD 
by  these  eight  lines. 

34 

PA1 

35 

PA  2 

36 

PA3 

37 

PA4 

38 

PA5 

39 

PA6 

40 

PA7 

MPU's  are  always  cleared.  For  the  same  reason  the  Timer  pins  are  connected  to 
Vcc  (see  Table  3). 

•  Bit  4,  External  Enable  (TEE),  is  not  used  by  the  measurement  system.  By  keeping 
the  TEE  clear  at  all  times,  the  68705's  internal  timer  is  used  exclusively. 

•  Bit  3,  Prescaler  Clear  (PSC),  is  not  used  in  this  application;  always  cleared. 

•  Bits  2-0,  Prescaler  Select  (PS2,  PS1  and  PSO),  are  always  set  during  program  exe¬ 
cution.  This  causes  the  internal  timer  signal  frequency  to  be  divided  by  128. 

(3)  Mask  Option  Register  (MOR).  Unlike  the  TDR  and  TCR  the  MOR 
is  not  software  programmable;  instead,  it  is  implemented  in  EPROM. 

•  Bit  7,  the  Clock  bit,  is  cleared  to  allow  operation  of  the  external  4.0  MHz  clock. 

•  The  Timer  Option  bit  (TOPT),  bit  6,  is  also  cleared  in  this  application.  This  per¬ 
mits  the  TCR  to  be  software  programmable. 

•  Bit  5  is  cleared  to  permit  the  use  of  the  internal  clock  with  the  timer. 

•  Bits  4  and  3  are  not  used. 
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•  Bits  2-0  are  all  set  and  serve  the  same  function  as  PS2,  PS1  and  PSO  bits  of  the 

TCR.  [Ref.  10:  pp.  6-8,  13-15] 

3.  RAM 

The  MC68705U3  has  112  bytes  of  RAM.  The  112  bytes  includes  31  bytes  that 
can  be  used  for  the  stack.  Use  of  the  stack  is  quite  limited.  During  interrupts  it  is  used 
to  save  the  contents  of  the  CPU  registers  and  the  program  counter.  During  subroutine 
calls  only  the  program  counter  is  saved.  The  user's  program  has  no  other  access  to  the 
stack.  The  programs  written  for  each  of  the  MPU's  require  less  than  25%  of  the  avail¬ 
able  RAM.  The  Pan  MPU  uses  27  of  the  112  available  bytes  and  the  Tilt  MPU  uses 
only  22  bytes.  The  programs  listed  in  Appendix  D  explain  the  function  and  give  the 
location  in  memory  for  each  of  the  variables.  [Ref  10:  p.  5] 

4.  ROM 

The  3776  bytes  of  user  EPROM  in  the  MC68705U3  are  divided  into  three  sep¬ 
arate  blocks  in  the  memory.  Page  Zero  User  EPROM  is  the  ROM  located  between  ad¬ 
dress  SOSO  and  SOFF.  Because  these  addresses  are  only  one  byte  long,  instructions 
located  in  Page  Zero  ROM  can  be  referenced  with  addressing  modes  not  permitted  with 
instructions  located  in  other  parts  of  the  memory.  Between  address  S100  and  SF37  is  the 
User  Main  EPROM.  This  portion  of  the  memory  in  each  MPU  contains  the  vast  ma¬ 
jority  of  the  signal  conditioning  programs.  Located  in  another  portion  of  the  EPROM 
are  the  Interrupt  Vectors.  In  each  of  these  locations  is  the  address  of  the  first  instruction 
the  MPU  is  to  execute  when  a  particular  interrupt  occurs. 

As  with  the  RAM  only  a  fraction  of  the  available  EPROM  has  been  used  in  this 
application.  The  Pan  MPU  uses  899  bytes  of  the  3776  available  and  the  Tilt  MPU  uses 
only  767  bytes.  Since  both  programs  are  so  small,  one  could  reasonably  ask  why  the  two 
programs  were  not  both  put  in  one  MPU.  The  primary'  problem  with  this  idea  is  that 
each  microprocessor  can  perform  only  one  operation  at  a  time.  As  indicated  at  the  end 
of  Chapter  II,  if  the  camera  serv  o  is  rotating  about  its  vertical  axis  at  its  maximum  ve¬ 
locity  of  1  rpm,  the  Pan  signal  conditioner  must  be  capable  of  counting  and  displaying 
51,200  counts  per  minute.  Using  a  4.0  MHz  clock  this  allows  the  MPU  1 172ms  to  count 
each  pulse.  Similarly  the  Tilt  MPU  has  1758ms  to  count  each  pulse  when  the  camera  is 
rotating  at  its  maximum  velocity  about  the  horizontal  axis.  Assuming  that  the  camera 
is  rotating  at  its  maximum  velocity  on  both  axes  at  the  same  time,  and  one  MPU  is  being 
used  to  count  the  pulses  from  both  encoders,  the  MPU  needs  to  count  76,800  pulses  per 
minute,  which  only  allows  781.3  ms  per  pulse.  The  Pan  MPU  currently  requires  a  max- 
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imum  of  1032  instruction  cycles  or  1032ms  to  count  a  single  pulse,  and  the  maximum 
execution  time  for  a  single  pulse  on  the  Tilt  axis  is  825ms.  Thus,  a  single  68705  lacks  the 
computational  speed  required  to  ensure  that  no  counts  would  be  missed  if  it  was  used 
to  process  the  data  from  both  encoders. 

5.  Central  Processing  Unit  (CPU) 

The  CPU  of  the  M6805  Family  is  implemented  independently  from  the  I/O  or 
memory'  configuration.  Consequently  it  can  be  treated  as  an  independent  central 
processor  communicating  with  I/O  and  memory  via  internal  address,  data  and  con¬ 
trol  buses.  [Ref  10:  p.  6] 

The  CPU  has  five  registers  that  are  available  for  use  by  the  operator.  The 
function  of  each  of  these  is  described  below. 

•  The  Accumulator  (A)  is  a  general  purpose  data  register  used  for  arithmetic  calcu¬ 
lation  and  data  manipulation. 

•  The  Index  Register  (X)  can  be  used  as  a  second  accumulator  but  is  generally  used 
for  the  indexed  addressing  mode.  In  the  indexed  addressing  mode  an  effective  ad¬ 
dress  is  created  by  adding  the  contents  of  X  to  a  number  provided  by  the  instruc¬ 
tion. 

•  The  Program  Counter  (PC)  contains  the  memory  address  of  the  next  instruction  to 
be  executed  by  the  MPU. 

•  The  five  bits  of  the  Condition  Code  Register  (CCR)  keep  information  concerning 
the  results  of  the  last  instruction  executed  by  the  MPU.  Reference  14  gives  a  de¬ 
tailed  description  of  each  of  the  instructions  in  the  M6805  Family  Instruction  Set 
and  explains  the  effect  of  each  instruction  on  the  CCR.  A  brief  description  of  each 
bit  in  the  CCR  follows. 

■  The  Carry  (C)  bit  is  set  if  a  carry'  or  a  borrow  was  generated  by  the  last  arith¬ 
metic  instruction.  The  state  of  the  C  bit  can  be  software  controlled. 

■  The  Zero  (Z)  bit  is  set  if  the  result  of  the  last  arithmetic,  logic  or  data  manipu¬ 
lation  instruction  was  zero. 

■  The  Negative  (N)  bit  is  set  if  bit  seven  of  the  result  of  the  last  arithmetic,  logic, 
or  data  manipulation  instruction  is  set. 

■  The  Half  Carry  (H)  bit  is  set  if  an  ADD  or  an  ADC  instruction  causes  a  carry 
to  occur  between  bits  3  and  4  of  the  result. 

■  The  Interrupt  Mask  (I)  bit  is  set  when  an  external  interrupt  (INT)  occurs.  If 
another  interrupt  occurs  (e.g.  Timer  Interrupt  or  INT2  )  when  the  I  bit  is  set, 
the  second  interrupt  is  latched  so  that  it  can  be  processed  as  soon  as  the  I  bit 
is  cleared.  The  I  bit  can  be  set  or  cleared  by  software. 

•  The  contents  of  the  Stack  Pointer  (SP)  are  the  address  of  the  next  available  location 
on  the  stack.  As  previously  discussed,  the  stack  is  only  used  to  keep  track  of  the 
PC  during  subroutine  branches,  and  all  of  the  CPU  registers  during  an  interrupt. 
[Refs.  10:  p.  6,  14  :  pp.  14-15] 
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6.  Input 

Each  MPL'  uses  six  input  lines.  Two  of  these  lines,  INT  and  1NT2  ,  are  inter¬ 
rupt  lines  that  detect  a  negative-going  edge  on  their  respective  lines.  The  other  four  lines 
are  general  purpose  input  lines  on  Port  D.  All  of  the  pins  on  Port  D  are  TTL  compatible 
which  made  the  hardware  design  relatively  straightforward.  The  electrical  character¬ 
istics  for  the  input  pins  are  listed  on  p.  2  of  Ref.  10. 

The  general  operation  of  the  two  interrupt  lines  is  described  in  Table  3  on  page 
39.  Once  they  are  understood,  interrupts  are  a  simple  yet  powerful  tool.  Only  three  of 
the  four  interrupts  available  on  the  MC68705U3  are  used  by  the  Pan  and  Tilt  programs. 
The  software  interrupt  is  not  used.  When  the  MPU  is  interrupted,  current  program  ex¬ 
ecution  is  halted,  the  contents  of  the  CPU  registers  are  placed  on  the  stack,  and  the 
MPU  fetches  the  contents  of  the  appropriate  interrupt  vector  from  memory.  After  the 
interrupt  vector  has  been  fetched,  the  PC  is  moved  to  that  address  and  execution  of  the 
interrupt  routine  begins.  There  is  no  ambiguity  when  an  external  interrupt  occurs  since 
there  is  a  dedicated  interrupt  vector  in  memory.  The  timer  interrupt  and  INT  however 
share  the  Timer  Interrupt  Vector.  When  one  of  these  interrupts  occurs,  the  interrupt 
routine  must  determine  the  source  of  the  interrupt  by  checking  the  T1R  bit  of  the  TCR 
and  bit  7  of  the  MR  to  determine  the  source  of  the  interrupt  [Ref.  10:  p.  11].  Normal 
program  execution  resumes  at  the  point  at  which  the  interrupt  occurred  when  the  inter¬ 
rupt  routine  executes  a  return  from  interrupt  (RTI)  instruction. 

The  Function  and  Set  lines  on  pins  20  and  21  are  connected  to  the  Function  and 
Set  switches.  The  operation  of  these  switches  is  described  in  Table  2  on  page  36.  The 
remaining  two  input  lines  to  each  MPU  are  Channels  A  and  B  from  the  respective  shaft 
encoders.  The  MPU  programs  use  the  information  from  these  two  inputs  to  determine 
the  direction  of  rotation  and  to  identify  repeated  oscillations  about  a  single  transition. 

7.  Output 

Each  MPU  is  designed  to  provide  position  information  at  its  output  in  two  basic 
forms.  On  the  Pan  axis,  in  the  Count  Mode  a  number  between  -51,200  and  +51,200 
constitutes  the  output  while  in  the  Position  Mode  the  output  is  an  angle  between  0°  and 
360°.  A  five  digit  display  with  a  minus  sign  is  sufficient  for  the  count  display.  Using  a 
five  digit  display  with  a  decimal  point  in  the  Position  Mode  permits  the  angle  to  be  dis¬ 
played  to  the  nearest  hundredth  of  a  degree.  This  resolution  is  not  quite  as  good  as  the 
resolution  of  the  shaft  encoders  (±0.007°);  however,  final  testing  of  the  measurement 
system  revealed  that  resolution  is  actually  limited  to  about  ±  0.02°  on  the  Pan  axis  and 


44 


about  ±  0.14°  on  the  Tilt  axis.  The  five  digit  display  is  therefore  completely  adequate 
for  this  system. 

The  Pan  MPU  uses  23  of  its  24  output  pins  to  represent  the  five  digits,  a  minus 
sign  and  a  decimal  point.  Each  of  the  five  digits  is  available  in  BCD  form  on  four  output 
pins  of  the  MPU.  The  five  digits  are  referred  to  as  Digit  1,  Digit  2,  etc.,  with  Digit  1 
being  the  least  significant  digit  and  Digit  5  being  the  most  significant  digit.  Port  A  has 
as  its  output  the  BCD  representation  of  Digit  3  and  Digit  4.  Digit  1  and  Digit  2  are 
represented  by  the  output  of  Port  C.  The  low  four  bits  of  Port  B  contain  the  BCD 
representation  of  Digit  5.  These  20  output  lines  are  the  input  to  five  74LS47, 
BCD  7-Segment  Decoder/Drivers,  which  decode  the  BCD  signals  and  drive  the  common 
anode  LED  indicators.  The  output  from  Pin  29,  PB4,  is  one  input  to  a  74LS32  OR  gate, 
the  output  of  which  is  used  to  blank  leading  zeros  out  of  the  display.  Pin  30  is  not  used 
and  is  tied  to  ground.  The  remaining  two  output  pins  drive  two  LED  segments  in  the 
display.  The  signal  on  pin  31  turns  the  minus  sign  off  and  on,  and  the  signal  on  pin  32 
determines  whether  the  decimal  point  is  displayed. 

The  electrical  characteristics  of  the  I/O  Ports  are  given  on  p.  4  of  Ref.  10.  The 
output  characteristics  of  Ports  A,  B  and  C  are  compatible  with  the  input  characteristics 
of  the  74LS47  and  the  74LS32  given  on  pp.  4-59  and  4-48  of  Ref  11.  The  pins  on 
Port  B  are  capable  of  sinking  10  mA  when  Port  B  is  configured  as  an  output  port.  A 
220  Q  resistor  placed  in  series  with  each  of  the  display  segments  limits  the  current  to 
approximately  9  mA  and  permits  the  MPU  to  drive  the  decimal  point  and  minus  sign 
directly. 

One  consideration  in  the  design  of  this  system  was  to  provide  a  system  capable 
of  being  readily  expanded  to  meet  changing  needs.  To  this  end,  in  addition  to  being 
connected  to  the  LED  display  devices  via  the  74LS47's,  the  BCD  data  lines  are  also 
connected  to  a  header  on  each  of  the  MPU  circuit  boards.  If,  at  a  later  date,  the  posi¬ 
tion  information  needs  to  be  used  in  another  system,  a  jumper  connected  to  each  of  the 
headers  could  provide  the  information  with  little  or  no  modification. 

The  Pan  and  Tilt  signal  processing  subsystems  are  virtually  identical  in  the 
hardware  used  to  implement  them.  The  only  difference  is  that  the  Pan  system  has  a  five 
digit  display,  and  the  Tilt  system  needs  only  four  digits  to  display  its  position  informa¬ 
tion.  Consequently,  the  Tilt  system  does  not  use  Digit  5,  and  pins  25-29  are  tied  to 
ground. 
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F.  DISPLAY 

Each  digit  represented  in  BCD  at  the  output  of  the  MPU  is  decoded  by  a  74LS47 
BCD  7-Segment  Decoder; Driver.  The  decoding  devices  each  convert  a  four  bit  BCD 
representation  of  a  number  into  seven  signals  that  each  drive  a  separate  segment  of  a 
common  anode,  seven  segment,  LED  display.  The  74LS47  is  capable  of  sinking  24  mA 
from  each  of  the  LED  segments.  Without  a  current  limiting  resistor  between  each  of  the 
output  pins  on  the  7447  and  the  corresponding  pin  on  the  display  element  however,  this 
maximum  current  is  exceeded.  When  this  happens  the  LED's  have  a  very  short  life,  the 
7447  overheats  and  the  system  fails  to  function  properly.  The  addition  of  a  220  £  re¬ 
sistor  in  each  branch  limits  the  current  to  about  9  mA  per  segment,  and  permits 
trouble-free  operation. 

Three  of  the  output  pins  on  each  MPU  are  not  used  as  inputs  to  the  7447's.  As 
discussed  in  the  previous  section,  the  Decimal  and  Minus  lines  each  drive  individual 
LED  segments  directly.  The  third  line,  also  mentioned  briefly  in  the  preceding  section, 
is  used  with  the  Blanking  In/ Ribbon  Blanking  Out  (BI/RBO)  signal  from  Digit  4's  7447 
to  determine  the  Ribbon  Blanking  In  (RBI)  signal  into  the  7447  which  drives  the  display 
for  Digit  3. 

The  term  “blanking”  simply  means  removing  the  leading  zeros  from  the  display. 
The  two  display  modes  available  from  the  MPU's  have  different  blanking  requirements. 
In  the  Position  Mode  the  three  least  significant  digits  are  not  blanked,  while  in  the 
Count  Mode,  all  but  the  least  significant  digit  are  blanked.  The  RBI  and  BI/RBO  pins 
on  the  7447's,  the  Blank  line  out  of  each  MPU  and  the  OR  gates,  connected  as  shown 
in  the  schematics  in  Appendix  A,  provide  this  capability. 

The  Light  Test  (LT)  pin  on  each  7447  is  connected  to  SW5.  When  the  switch  is 
closed,  the  Light  Test  line  goes  low  and  each  of  the  output  lines  on  each  of  the  7447's 
also  goes  low,  thus  sinking  current  from  all  of  the  LED  segments  simultaneously.  This 
feature  allows  the  operator  to  check  for  inoperable  display  segments. 

G.  POWER  SUPPLIES 

The  two  power  supplies  shown  in  Figure  2  on  page  6  are  each  +  5.0  Vdc  supplies. 
The  power  supply  which  provides  power  to  the  shaft  encoders  and  the  line  drivers  is 
physically  mounted  in  the  camera  housing.  It  was  built  by  modifying  the  +12  Vdc  auto 
iris  power  supply.  This  was  accomplished  using  an  LM7805  Voltage  Regulator  in  the 
manner  shown  in  Figure  8  of  Appendix  A.  The  auto  iris  requires  only  100  mA  at 
+  12  Vdc  for  correct  operation,  and  the  LM7812  Voltage  Regulator  has  an  available 
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output  current  of  1.0  A  [Refs.  15,  16J.  The  remaining  900  mA  is  available  to  the 
LM7805  to  power  the  encoders  and  the  line  drivers.  Reference  9  lists  the  maximum 
power  requirement  for  the  1IEDS-600  as  40  mA  at  +5  Vdc,  and  Ref.  11  specifies  the 
maximum  power  requirement  for  a  74SI40  is  I  mA  at  +5  Vdc.  Thus,  the  84  mA  re¬ 
quirement  for  the  two  encoders  and  four  line  drivers  is  well  within  the  capabilities  of  the 
modified  power  supply. 

The  second  power  supply  is  capable  of  providing  6.0  A  at  +  5  Vdc  which  is  more 
than  adequate  to  provide  the  1.4  A  needed  by  the  signal  processors  and  the  display  de¬ 
vices.  The  power  supply  also  has  12  Vdc  and  -5  Vdc  ports.  To  preclude  the  potentially 
disastrous  results  which  might  occur  if  the  power  supply  were  incorrectly  connected  to 
the  signal  processor/display  devices,  the  circuitry  shown  in  Figure  21  was  included  on 
each  MPU  and  display  printed  circuit  board. 


Figure  21.  Reverse/Over-voltage  Protection  Circuit 


IV.  CALIBRATION  ,  TESTING  AND  IMPLEMENTATION 

A.  GENERAL 

Once  the  basic  system  design  had  been  completed,  and  the  MPU  programs  had  been 
written,  a  prototype  system  was  constructed.  The  prototype  system  might  also  be  called 
the  development  model,  since  it  was  not  only  used  to  test  the  design  ,  but  was  also  used 
to  calibrate  the  MPU  programs.  A  block  diagram  of  the  prototype  system  is  shown  in 
Figure  22.  The  M68705EVM  Evaluation  Module  (subsequently  referred  to  as  the 
EVM)  provided  the  capability  to  debug  and  evaluate  the  MC68705U3-based  signal 
processing  subsystem.  Operation  of  the  signal  processing  MPU  was  performed  by  an 
MC6S705U3  resident  on  the  EVM. 

The  prototype  system  provided  considerable  flexibility  in  the  testing  and  calibration 
of  the  system.  The  assembly  language  programs  for  the  MPU's  were  written  and  edited 
on  the  PC.  They  were  then  assembled  and  linked  using  the  2500  A.D.  6805  Cross  As¬ 
sembler  and  2500  A.D.  Linker  [Ref.  17:  pp.  (l-l)-(2-38)].  The  result,  a  Motorola  S19 
output  file  (see  [Ref.  17:  pp.  (A-l)-(A-4)]),  was  then  down-loaded  to  the  EVM  using  the 
file  transfer  program,  Kermit.  Downloading  procedures  are  detailed  in  [Ref.  18:  pp. 
(3-10>-(3-25),(3-37)].  The  PC-EVM  interface  is  shown  in  Figure  23. 

After  the  program  had  been  down-loaded  into  the  MC68705U3  resident  on  the 
EVM,  data  entry  and  program  debugging  were  controlled  via  the  CRT  monitor  key¬ 
board.  The  CRT-EVM  interconnection  is  shown  in  Figure  24  and  the  monitor  com¬ 
mands  are  described  in  [Ref.  18:  pp.  (3-8)-(3-25)]. 

The  remainder  of  the  signal  processing  functions  were  realized  using  hardware  ex¬ 
ternal  to  the  EVM.  These  functions  included  edge  detection  of  the  output  signals  from 
the  shaft  encoders,  decoding  the  output  of  the  MPU,  and  generating  the  signals  to  drive 
the  display  devices.  This  portion  of  the  prototype,  referred  to  by  (Ref.  18J  as  the  “target 
system”,  was  built  on  breadboards  and  is  represented  by  the  block  in  the  center  of 
Figure  22.  The  target  system  was  connected  to  the  MCU  via  a  40-pin  jumper  header, 
J 1 ,  on  the  EVM.  The  pinout  for  J1  is  shown  in  Figure  25.  The  labels  in  Figure  25  refer 
to  the  labels  used  in  the  schematic  diagrams  which  are  shown  in  Appendix  A. 

B.  CALIBRATION 

Once  the  MPU  programs  were  capable  of  counting  the  pulses  generated  by  the  shaft 
encoders,  the  programs  needed  to  be  “calibrated".  This  calibration  procedure  required 


48 


49 


REMOTE  CONTROL 


Figure  23.  Host  Computer  -  Evaluation  Module  Connections 
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Figure  24.  Monitor  -  Evaluation  Module  Connections 
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Figure  25.  Evaluation  Module  -  Signal  Processor  Connections 
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determining  the  angular  distance  through  which  the  camera  rotated  between  successive 
pulses  from  the  shaft  encoder.  This  number  is  a  scale  factor,  which,  when  multiplied  by 
the  total  number  of  pulses  from  the  shaft  encoder,  yields  a  number  equal  to  the  angular 
displacement  of  the  camera.  The  calibration  procedure  also  involved  determining  the 
amount  of  hysteresis  present  in  each  of  the  gear  trains. 

1.  Scale  Factor 

To  determine  the  scale  factor  (SF)  the  simple  geometric  relationship 


6  =  tan 


( 


opposite 

adjacent 


(12) 


was  used.  Using  a  small  laser  attached  to  the  camera  servo,  and  the  geometry  shown  in 
Figure  26,  the  SF  could  be  experimentally  determined.  As  the  camera  servo  was  rotated 
through  an  angle,  8,  the  MPU  was  used  to  count  the  output  pulses  from  the  shaft  en¬ 
coder.  The  laser  beam  was  projected  on  a  vertical  surface  at  a  distance,  a,  away  from 
the  axis  of  rotation.  The  beam  of  the  laser  spread  to  a  diameter  of  approximately  0.4 
in.  over  a  distance  of  30  ft.  A  template  with  a  0.4  in.  diameter  aperture  was  used  to  mark 
the  location  of  the  “spots”  on  the  distant  wall.  The  distance  between  the  spots,  /,  was 
measured  by  selecting  one  edge  of  one  of  the  marks  and  measuring  the  distance  to  the 
corresponding  edge  of  the  distant  mark.  Then,  having  determined  /  and  a  and  reading 
the  count,  C,  from  the  display,  the  SF  could  then  be  determined  from 
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Using  Equation  (13)  to  simplify  the  expression, 
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Figure  26.  Geomelry  Used  to  Determine  the  Scale  Factor 


d(SF)  = 


1  6Q  ,  1  SO 


C  SI  C  6a 


da 


c  ( „!+/!  )d,+ c  (■  y+?  y° 


d(SF)  = 


(ad/ — /da) 
C(a2  + 12) 


(15) 


which  indicates  that  C,  a  and  /  should  all  be  as  large  as  possible  to  minimize  the  error 
in  SF  due  to  a  measurement  error  in  a  or  /.  The  physical  size  of  the  laboratory  limited 
the  distance,  a  ,  to  30  ft.  When  a  -  30  ft,  /  was  limited  to  about  3.5  ft  in  the  horizontal 
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plane  and  about  4.0  A  in  the  vertical  plane.  By  modifying  the  geometry  as  shown  in 
Figure  27,  the  count,  which  from  Equation  (13)  is  directly  proportional  to  6,  could  also 
be  maximized.  The  configuration  shown  in  Figure  27  was  used  to  obtain  the  scale  fac¬ 
tor  calibration  data  for  the  Pan  axis.  However,  since  the  servo  is  incapable  of  rotating 
360°  about  the  Tilt  axis,  the  test  configuration  shown  in  Figure  26  had  to  be  used  the 
collect  the  data  for  that  axis. 


Figure  27.  Alternate  Geometry  Used  to  Determine  the  Scale  Factor 

Adopting  the  notation,  X,  to  represent  the  mean  value  of  a  random  variable, 
X;  if  X  is  discrete  with  N  measured  values, 

N 

(,6) 

lm  I 
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where  A’  is  the  /th  measured  value  of  X,  and  the  approximation  becomes  better  as  N 
approaches  infinity. 

Using  the  expression  in  Equation  (16)  and  the  measured  data  for  the  scale  fac¬ 
tors,  from  31  measurements  on  the  Pan  axis, 

SFpan  =  (7-°312x  lO'YPulse"1  ,  (17) 

and  after  32  measurements  on  the  Tilt  axis, 

SFTiU  =  (7.0452  x  10-3)°Pulse-1  ,  (18) 

where  the  subscripts  indicate  the  axis.  The  actual  implementation  of  these  scale  factors 
is  described  later  in  this  chapter  and  in  the  documentation  for  each  of  the  MPU  pro¬ 
grams. 

If  the  error  in  the  /th  measurement  is  described  by 

e,  =  Af,-X,  (19) 

then  the  root  mean  square  (RMS)  error  in  X  measurements  of  X  is  given  by; 


Note  that  this  is  also  the  definition  of  the  standard  deviation  of  X. 

The  RMS  errors  in  the  Pan  and  Tilt  scale  factor  measurements  were  determined 
from  Equation  (20)  and  the  measured  data  to  be; 


aSFPin  =  (4-62  x  10-6)°Pulse-1 

(21) 

<7SFt)|  =  (6.89  x  10-6)°Pulse-1  . 

(22) 

As  before,  the  subscripts  are  used  to  identify  the  axis  and  the  source  of  the  error.  The 
fact  that  the  errors  are  small  compared  to  the  mean  values  suggests  that  the  means 
should  closely  approximate  the  actual  values  for  the  scale  factors. 

2.  Hysteresis 

Houghton  defines  backlash  in  wormgearing  as  “...the  total  play  between  the 
surfaces  of  the  worm  and  worm  wheel  teeth  measured  normal  to  the  faces.”  [Ref.  19: 
pp.  1.4,  1.5]  Backlash  only  poses  a  problem  in  the  measurement  system  when  the  servo's 
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direction  of  rotation  changes.  Figure  28  is  a  typical  hysteresis  curve.  As  long  as  the 
direction  of  rotation  of  the  worm  is  increasing  the  0WOrm/0 worm gear  relationship  is  linear. 
However,  when  the  direction  of  rotation  reverses  there  is  a  region,  depicted  by  the  left 
pointing  arrows,  where  the  position  of  the  worm  changes  without  a  corresponding 
change  in  the  position  of  the  wormgear.  Note  that  once  all  of  the  backlash  has  been 
taken  up  the  0Worm/0wormgear  relationship  is  again  linear  until  the  direction  of  rotation 
changes. 


Figure  28.  Typical  Hysteresis  Curve 

The  purpose  of  the  hysteresis  buffer  in  the  MPU  is  to  permit  the  signal 
processor  to  account  for  the  backlash  error  introduced  into  the  measurement  by  the 
worm-wormgear  connection.  The  theory  of  operation  for  the  buffer  is  relatively  straight 
forward  and  is  best  described  by  the  flow  diagram  in  Figure  29.  The  buffer  is  a  data 
byte  in  the  MPU  RAM.  As  long  as  the  bulfer  is  full,  i.c.,  the  contents  are  equal  to  the 
predetermined  buffer  length,  a  clockwise  (CW)  signal  from  the  shaft  encoder  (increasing 
elevation  and  increasing  azimuth  are  defined  as  CW  rotation  for  the  purposes  of  this 
system)  causes  the  position  counter  to  be  incremented.  Similarly,  counter-clockwise 
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Figure  29.  Operation  of  the  Hysteresis  Buffer 
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Figure  30.  Hysteresis  Curve 


(CCW)  signals  cause  the  position  counter  to  be  decremented  if  the  hysteresis  buffer  is 
empty,  i.e.,  the  contents  are  equal  to  zero.  These  two  situations  correspond  to  the  two 
linear  sections  in  Figure  28.  From  Equation  ( 13),  the  horizontal  separation  or  these  two 
lines  is  related  to  the  length  of  the  hysteresis  buffer,  CH  by  the  expression 


CH  = 


SF 


(23) 


Similarly,  using  the  SF  to  map  0WORM  into  C,  and  the  fact  that  the  displacement  of  the 
wormgear  equals  the  displacement  of  the  axis  of  interest,  the  curve  shown  in  Figure  30 
can  be  obtained  from  Figure  28.  From  Figure  30  it  is  apparent  that  two  different  pulse 
counts  can  be  obtained  for  any  given  position,  6,  depending  on  whether  that  position  is 
approached  from  a  CW  or  a  CCW  direction.  The  difference  in  the  two  counts  is  a 
measure  of  the  hysteresis  present  in  the  gear  train  and  is  also  the  required  length  for  the 
hysteresis  buffer.  By  using  this  difference  as  the  length  of  the  hysteresis  buffer,  counts 
received  by  the  MPL  which  occur  while  the  gears  are  operating  on  one  of  the  horizontal 


59 


sections  of  the  curve  in  Figure  30  are  not  considered  “valid"  and  therefore  do  not  cause 
the  MPL'  to  modify  the  position.  Using  Equation  (23)  and  data  collected  in  the  labo¬ 
ratory  the  average  hysteresis  present  in  each  of  the  gear  trains  was  determined  (from  45 
measurements  on  the  Pan  axis  and  30  measurements  on  the  Tilt  axis)  to  be 


CH(Pan)  =  7-39  Pulses  (24) 

Cj-|(Tiit)  ~  6.06  Pulses  (25) 

and  the  RMS  errors  were  calculated  to  be, 

ffc„(Plft)=  1-0  Pulses  (26) 

•c™- 0.91  Pulses  .  (27) 


C.  IMPLEMENTATION  OF  THE  CALIBRATION  DATA 
1.  Background 

Figure  31  outlines  the  basic  operation  of  each  of  the  MPU’s.  Although  each 
of  the  routines  is  described  in  detail  by  the  comments  included  in  the  programs,  the  op¬ 
eration  of  the  Count  Routine  is  the  heart  of  the  program  and  should  be  explained  prior 
to  discussing  the  actual  implementation  of  the  experimental  results. 

When  the  system  operator  causes  the  camera  servo  to  rotate,  each  optical  shaft 
encoder  translates  the  displacement  of  one  of  the  axes  into  two  series  of  digital  pulses. 
The  two  pulse  trains,  referred  to  as  Channels  A  and  B,  are  TTL  logic  level  signals.  When 
the  logic  level  of  Channel  A  transitions  from  low  to  high  (rising  edge  transition)  or  from 
high  to  low  (falling  edge  transition),  the  edge  detector  (See  Figure  15  on  page  33)  pulls 
pin  3  of  the  associated  MPL  low  for  approximately  2  ^sec.  When  this  occurs  an  ex¬ 
ternal  interrupt  (EXT  INT  or  INT  )  request  is  generated  and  the  MPU  begins  execution 
of  the  Count  Routine. 

As  mentioned  in  Chapter  III,  since  both  rising  and  falling  edge  transitions  are 
detected  by  the  edge  detector,  the  signal  processor  must  be  capable  of  detecting  multiple 
oscillations  of  the  shaft  about  a  single  logic  level  transition  point.  Accordingly,  the  first 
tasks  performed  by  the  Count  Routine  are  to  determine  the  direction  of  rotation  and  to 
simultaneously  determine  whether  the  interrupt  is  the  result  of  a  stationary  shaft  oscil¬ 
lation.  To  do  this  the  Count  Routine  checks  the  state  of  pin  17  (Channel  A)  and  pin 
19  (Channel  B).  Operation  of  this  portion  of  the  routine  is  summarized  in  Table  5. 
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Figure  31.  Program  Flow  Diagram:  Program  executes  in  the  Wait  Loop  until;  (a) 
the  operator  requests  to  modify  the  hysteresis  bufTer,  (b)  the  operator 
requests  to  change  the  display  mode,  (c)  an  external  interrupt  is  gener¬ 
ated  by  the  Channel  A  edge  detector  or,  (d)  a  timer  interrupt  causes  the 
display  mode  to  “blink".  All  interrupt  routines  are  terminated  with  a 
return  from  interrupt  (RT1)  command. 
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Note  that  CW  rotation  is  indicated  when  Channel  B  leads  Channel  A  in  phase  and  CCW 
rotation  is  indicated  if  Channel  A  is  leading  Channel  B.  The  possibility  of  erroneously 
counting  multiple  oscillations  about  a  single  point  is  eliminated  by  “counting”  only  the 
leading  edge  transitions  when  the  shaft  is  rotating  CW  and  only  the  trailing  edge  tran¬ 
sitions  when  the  rotation  is  CCW.  All  other  transitions  cause  the  program  to  execute 
a  “return  from  interrupt”  (RTI)  instruction. 

2.  Implementing  the  Hysteresis  Buffer 

The  transitions  that  are  to  be  counted  cause  the  program  to  compare  the  con¬ 
tents  of  the  hysteresis  buffer,  HYSTCT,  and  the  direction  of  rotation  to  the  exper¬ 
imentally  determined  buffer  length,  HYST2sCh  .  If  the  rotation  is  CW  and  the  buffer  is 
full  (i.e.,  HYSTCT=  HYST),  or  if  the  rotation  is  CCW  and  the  buffer  is  empty  (i.e., 
HYSTCT  =  0),  then  the  “slack”  due  to  the  gear  backlash  should  have  been  taken  up  , 
the  transitions  are  considered  “valid”  and  the  MPU  modifies  the  position  appropriately. 
“Invalid”  counts  cause  the  contents  of  the  hysteresis  buffer  to  be  incremented  or  decre¬ 
mented  depending  on  whether  the  present  direction  of  rotation  is  CW  or  CCW 
(Figure  29  refers). 


Table  5.  COUNT  ROUTINE  LOGIC 


Channel  A 

Channel  B 

Direction 
of  Rotation 

Count  the 
Pulse? 

Action 

Low 

Low 

CW 

No 

Increment  the 
hysteresis  buffer. 

Low 

High 

CCW 

Yes 

Decrement 
the  position. 

High 

Low 

CCW 

No 

Decrement  the 
hysteresis  buffer. 

High 

High 

CW 

Yes 

Increment 
the  position. 

From  the  calibration  data  for  the  Pan  axis,  CHiPtn)a:7.4  and  ^cH(Pinl- 1 Because 
the  length  of  the  hysteresis  buffer  must  be  an  integer  value,  CWPin),  needed  to  be  rounded 
off.  Rounding  to  the  nearest  whole  number  initially  seemed  the  most  logical  approach. 
Upon  further  consideration,  however,  it  was  decided  to  round  7.4  up  to  8.  Considering 
the  relatively  small  data  base  (45  measurements)  upon  which  the  average  was  based,  the 
fact  that  the  standard  deviation  was  1.0  and  that  the  gear  backlash  will  only  increase 
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with  time,  this  seemed  like  the  most  reasonable  approach.  The  buffer  length  for  the  Tilt 
axis  was  set  equal  to  6  (CH,Tlll)  =  6.06) . 

3.  Implementing  the  Scale  Factor 

There  are  three  counters  in  each  MPU  that  keep  track  of  the  position  informa¬ 
tion  for  the  axis  of  interest.  The  first,  BINCT,  is  simply  a  binary  counter  that  is  incre¬ 
mented  by  one  for  each  valid  CW  count  and  decremented  by  one  for  each  valid  CCW 
count.  The  other  two  counters  consist  of  two  sets  of  pointers,  two  sets  of  data  registers 
and  a  shared  data  table.  Each  byte  in  a  pointer  points  to  an  address  in  the  table  that 
contains  two  BCD  digits  which  make  up  a  portion  of  the  position  information. 

In  order  to  increment  (decrement)  the  pulse  count,  BCDCT,  by  one,  the  count 
pointer,  CTPTR,  is  incremented  (decremented)  by  one  causing  it  to  point  to  a  new  table 
address.  The  contents  of  the  table  at  the  new  addresses  are  then  moved  into  BCDCT. 
Modification  of  the  position  counter,  DEGRES,  is  performed  in  much  the  same  manner. 
DEG  RES  contains  a  BCD  number  that,  when  multiplied  by  0.001,  represents  the  angu¬ 
lar  position  (in  degrees)  of  the  shaft  of  interest.  Thus,  each  time  the  camera  is  displaced 
in  a  CW  direction  through  one  degree,  the  contents  of  DEGRES  should  be  incremented 
by  1000.  To  do  this,  the  position  pointer,  PTR,  must  be  incremented  (decremented)  by 
seven  or  eight  each  time  CTPTR  is  incremented  (decremented)  by  one.  Incrementing 
PTR  by  seven  corresponds  to  an  angular  displacement  of  0.007°  and  since 
SFPan  and  SFTm  are  each  slightly  larger  than  0.007°,  periodically  PTR  must  be  incre¬ 
mented  by  eight  to  reduce  the  cumulative  round  off  error.  Specifically,  if  PTR  is  incre¬ 
mented  by  seven  each  time  a  valid  CW  pulse  is  detected  (except  when  BINCT  is  an  even 
multiple  of  32)  and  is  incremented  by  eight  when  BINCT  is  a  modulo  32  number,  the 
effective  scale  factor  is  given  by; 


SF^  =  lV(31(0-007)  +  °-008) 

=  0.00703 125°Pulse~'  , 


(28) 


which  is  slightly  larger  than  the  desired  0.00703 12°Pulse_I,  for  the  Pan  axis  and  slightly 
smaller  than  the  desired  0.0070452°Pulse-‘  for  the  Tilt  axis.  To  further  reduce  the  cu¬ 
mulative  round  off  on  the  Pan  axis,  every'  16,384  (2|4=  32  x  512)  counts  PTR  is  incre¬ 
mented  by  seven  instead  of  eight.  This  results  in  an  effective  scale  factor  of. 
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(29) 


SVefh  =  {51 1[  (31(7)  +  8)  x  10-3]  +  0.00?j 

=  (7.031 19  x  10-3)0 Pulse-1  , 


which  is  within  two  parts  in  one  million. 

The  maximum  error  introduced  into  the  measurement  should  occur  when  the 
camera  is  rotated  through  the  largest  possible  angle.  To  predict  this  error  on  the  Pan 
axis,  when  the  camera  has  been  displaced  by  360°, 


BCDCT  = 


SF 


Pan 


=  51,200  Pulses 


(30) 


so  the  position  error  using  SF,^  and  SF,ffj  should  be; 

ePan  =  360°  -  [3(SF<//2)  +  (51,200  -  3(16,384))(S^)] 

=  0.00295°  .  [ 

Thus,  the  error  due  to  the  scale  factor  on  the  Pan  axis  should  be  well  within  the  desired 
resolution  of  ±  0.006°  . 

Using  SF,/f]  alone  as  the  scale  factor  for  the  Tilt  axis,  the  maximum  theoretical 
error  over  ±12°  due  to  the  scale  factor  round  off  is  determined  in  the  same  manner. 


1 7° 

BCDCT  =  =— 

SFm 

=  17,033  Pulses 


(32) 


So  that, 


em=12°-  17,033(SFe//j) 

=  0.0234°  ,  '  ’ 

which  again  is  significantly  less  than  the  required  resolution  of  ±0.23°  for  the  Tilt  axis. 

The  final  step  in  the  Count  Routine  is  a  branch  to  the  Display  Routine.  De¬ 
pending  on  whether  the  MPL  is  in  the  Count  or  Position  Mode,  the  Display  Routine 
copies  the  contents  of  BCDCT  or  DEGRES  to  the  output  ports  and  then  executes  an 
RTI  instruction. 
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D.  FINAL  TESTING 
1.  General 

Final  laboratory  testing  and  evaluation  of  the  measurement  system  was  per¬ 
formed  after  the  calibration  results  had  been  implemented  in  each  of  the  MPU  Count 
Routines.  The  purpose  of  the  testing  was  to  verify  that  the  calibration  results  had  been 
properly  coded  into  the  MPU's  and  to  determine  the  resolution  capabilities  of  the 
measurement  system  experimentally. 

This  verification  process  included  determining  the  combined  error  due  to  the 
hysteresis  and  scale  factor  errors.  The  use  of  some  simple  multiple  random  variable 
theory  was  therefore  required.  From  [Ref.  20:  pp.  121,122]  the  variance  of  a  weighted 
sum  of  M  random  variables  is  the  weighted  sum  of  their  covariances,  CXlX,  and  is  given 
by, 


M  M 

°2  =  Z  Z^A,,  >  (34) 

i=!  y=l 

where  a,  is  the  weight  associated  with  X,.  Additionally,  the  covariance  can  be  expressed 
as 


CXY  =  P*x®y  . 


(35) 


where  p  is  the  normalized  second-order  moment  and  is  known  as  the  correlation  coeffi¬ 
cient  of  X  and  V.  The  correlation  coefficient  is  bounded  by 


-1  ^  p  <  1  . 


(36) 


In  the  case  where  there  are  two  equally  weighted  random  variables,  M  =  2  and 
a,  =  ft,  =  1.0.  Substituting  into  Equation  (34)  and  expanding 


°  -  Cxx  +  ^XY  +  ^"YX  +  CyY  • 


(37) 


Using  Equation  (35), 


a2  =  o\  +  2poxO\  +  cty 


(38) 


Combining  (36)  and  (38)  yields 


d \  2<7XCTV  +  Oy  <  O  ^  Ox  4"  2oxOy  +  Oy 


(39) 
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The  bounds  of  the  combined  scale  factor  and  hysteresis  errors  can  therefore  be  deter¬ 
mined  from 


v4-V*h  +  ^h 


^  O'  ^  V 


4“  2(7-  Off  4"  Off 
Hf  «SF 


(40) 


where: 

•  a,  =  standard  deviation  of  the  combined  error, 

•  a^T  ~  standard  deviation  of  the  scale  factor  error,  and 

•  -  standard  deviation  of  the  hysteresis  error. 

Note  that  the  bounds  are  determined  by  the  two  cases  where  the  hysteresis  error,  eH,  and 
the  scale  factor  error,  eSF,  are  “completely  correlated”.  The  upper  bound  corresponds 
to  the  case  where  an  increase  in  eSF  implies  an  increase  in  eH,  and  the  lower  bound  cor¬ 
responds  to  the  case  where  an  increase  in  eSF  directly  implies  a  decrease  in  eH. 

A  third  case  is  also  of  particular  interest.  If  eH  and  eSF  are  completely  uncor¬ 
related,  i.e.,  p  =  0,  then  from  Equation  (38), 

^=44  +  %  ’  (41) 


which  can  also  be  written  as 

e  =  ±  \  4f  +  eH  »  (4~) 

where  e  -  ±  a,  is  the  1.0  a  error  due  to  the  scale  factor  and  hysteresis  errors,  eSF  and  eH 
respectively.  Based  on  the  physical  nature  of  the  two  errors  it  is  reasonable  to  assume 
that  eSF  and  eH  are  statistically  uncorrelated;  however,  no  experimental  data  was  collected 
to  support  this  hypothesis.  Due  to  this  lack  of  a  priori  information,  the  maximum  RMS 
error,  em„  =  ±  <7W  given  by 

t 1  '  "  ■ 

emax  =  ±  \  eSF  +  2eSFeH  +  e^  ,  (43) 

will  be  used  to  describe  the  resolution  capabilities  of  the  measurement  system. 

2.  Pan  Axis 

a.  Hysteresis 

To  test  the  operation  of  the  Pan  axis  hysteresis  bufTer,  the  Initialization 
Routine  was  programmed  to  set  the  buffer  length  to  8.  Then,  as  described  in  the  first 
section  of  this  chapter,  the  servo  was  used  to  position  the  beam  of  a  small  laser  on  a 
fixed  target.  By  approaching  the  target  alternately  from  a  CW  and  a  CCW  direction  and 
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comparing  the  difference  in  the  output  counts  from  the  shaft  encoders,  the  hysteresis 
error  was  determined.  The  average  error  after  31  measurements  was 

^H(Pan)  —  -0-1880  Pulses  ,  (44) 

and  the  RMS  error  was 

%P.n)=I-7699  Pulses  •  (4*) 

Since  the  mean  error  is  “near  zero”  compared  to  the  standard  deviation,  the  1.0  a  error 
eH,  due  to  the  hysteresis  can  be  determined  from 

eH-±(%)SF  (46) 


so  that 

eH(Pan,  =  ±  0.0124°  .  (47) 


b.  Scale  Factor 

Verification  of  the  scale  factor  was  performed  in  the  same  manner  as  the 
scale  factor  calibration,  except  that  the  MPU  was  calibrated  in  the  Count  Mode  and 
tested  in  the  Position  Mode.  Since  these  tests  sought  to  find  the  maximum  error  due  to 
the  scale  factor,  and  the  error  is  directly  proportional  to  the  angle  that  is  being  meas¬ 
ured,  these  tests  were  conducted  by  displacing  the  camera  servo  through  the  maximum 
angles  permitted  by  the  camera  and  the  laboratory.  Specifically,  on  the  Pan  axis  the 
servo  was  rotated  through  approximately  360°.  The  mean  error  due  to  the  scale  factor 
on  the  Pan  axis  was  determined  from  15  samples  to  be 

^SF(Pan)  =  — 0.0018°  (48) 

and  the  RMS  error  was 

a.  =0.00890°  .  (49) 

®SFi  Pin)  v  ' 

As  with  the  hysteresis  error,  if  we  neglect  the  small  bias  due  to  the  eSF(Piri)  ,  we  can  de¬ 
scribe  the  1.0  o  RMS  error  due  to  the  scale  factor  as 

eSF(Pan)  ~  i  °SF(Pan)  , 

=  ±0.00890°  '  (  ’ 
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c.  Combined  Error 


From  Equation  (42)  the  combined  error  on  the  Pan  axis  if  eH  and  eSF  are 
uncorrelated  can  be  estimated  as 


ePan  =  ±  7(0-01 24)2  +  (0.0089)2 
=  ±0.01526°  . 


(51) 


And  from  Equation  (43)  the  maximum  combined  error  on  the  Pan  axis  is 

epan^  =  ±  >.0124)2  +  2(0.0124)(0.0089)  +  (0.0089)2  (52) 


ePanm„  =  ±  0-0213°  .  (53) 


The  combined  error  is  approximately  three  times  larger  than  the  design  specification 
limit  and  is  due  primarily  to  the  hysteresis  error. 

3.  Tilt  Axis 

a.  Hysteresis 

The  procedure  used  to  verify  the  operation  of  the  calibrated  Tilt  MPU  was 
identical  to  that  described  in  the  previous  section.  Using  a  hysteresis  buffer  length  of  6 
resulted  in 


eH(TiU)  =  —0.0965  Pulses 


(54) 


and, 


<Vr„„=  13156  Pul$eS 

after  13  samples.  As  before  we  can  define  the  1.0  o  error  from  e  =  <rSF  to  be 

eH  =±0.00529°  . 

nTi1t  — 


(55) 


(56) 


b.  Scale  Factor 

Testing  the  scale  factor  on  the  Tilt  axis  was  limited  by  the  physical  con¬ 
struction  of  the  servo  and  the  size  of  the  laboratory.  The  angle  over  which  testing  could 
be  performed  was  limited  to  ±6°  from  the  horizontal  plane.  Consequently,  the  RMS 
error  for  the  scale  factor  on  the  Tilt  axis  was  determined  in  exactly  the  same  manner  as 
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the  RMS  error  for  the  Pan  axis  scale  factor,  but  since  the  error  due  to  rounding  of  the 
scale  factor  is  directly  proportional  to  the  angle  being  measured  the  results  were  multi¬ 
plied  by  2.0  to  account  for  the  limited  range  of  the  test.  The  modified  results  should 
therefore  be  representative  of  the  maximum  error  one  should  expect  if  the  measurement 
system  is  used  to  measure  elevation  angles  over  a  range  of  ±  12°  . 

The  error  due  to  the  scale  factor  is  described  from  16  samples  by 

eSF(Tiit) =  0.0070°  (57) 


and, 


oe  =  0.0665“ 

*SF(TiU) 


(58) 


Including  the  factor  of  two  in  the  calculation  we  have 

esF(Tiit) =  —  2(0.0665°) 
=  ±0.1330°  . 


c.  Combined  Error 

The  combined  RMS  error  is  determined  in  the  same  manner  as  before.  If 
eH  and  eSF  are  uncorrelated, 


eTlll  =  ±  v  (0.1330)2  +  (0.00529)2 
=  0.1331°  , 

and  the  maximum  combined  RMS  error  is 

eTlllmix  =  ±  x/(0.1330)2  +  2(0.1330)(0.00529)  +  (0.00529)2 


(60) 


(61) 


eTlum„  =  ±  0.1383°  .  (62) 


The  Tilt  axis  measurement  system  appears  to  perform  well  within  the  required  resolution 
specifications. 
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E.  FINAL  IMPLEMENTATION 

Once  the  program  debugging,  calibration  and  testing  were  completed,  final  imple¬ 
mentation  of  the  system  remained.  Taking  the  design  from  the  prototype/development 
model  to  a  fully  functional  sy  stem  was  a  straightforward  but  time-consuming  evolution. 

The  plans  for  the  printed  circuit  boards  (PCB's)  were  made  directly  from  the  sche¬ 
matics  shown  in  Appendix  A;  the  boards  were  then  etched  and  assembled  from  the  plans 
w'hich  are  shown  in  Appendix  B.  All  of  this  work  was  performed  by  sailors  attached  to 
the  Academic  Division  of  the  NPS. 

As  previously  discussed,  the  M68705EVM  Evaluation  Module  provided  a  powerful 
and  flexible  means  of  debugging  and  evaluating  the  performance  of  the  microprocessor 
based  signal  conditioner.  Additionally,  once  program  testing  w-as  completed  the  EVM's 
EPROM  microprocessor  programmer  provided  the  means  to  program  the  EPROM 
MCL"s.  A  detailed,  but  simple  to  follow,  programming  procedure  for  programming  the 
MC6S705U3  is  given  in  [Ref.  18:  pp.  (3-26)-(3-27)]. 
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V.  CONCLUSIONS  AND  RECOMMENDATIONS 

A.  SYSTEM  PERFORMANCE 

The  prototype  system  was  calibrated  and  successfully  tested  in  a  laboratory  environ¬ 
ment.  Experimental  results  indicate  that  the  system  is  capable  of  measuring  the  video 
camera's  elevation  over  a  range  of  ±12°  with  a  resolution  of  ±0.138°  and  its  azimuth 
over  360°  with  a  resolution  of  ±0.021°.  The  system  was  designed  to  be  low  cost,  reliable, 
and  easy  to  operate.  Only  time  will  tell  whether  these  objectives  were  truly  achieved. 

The  portion  of  the  system  that  will  be  located  outdoors  has  been  weatherproofed 
and  is  ready  to  be  placed  in  service.  Printed  circuit  board  plans  for  the  remainder  of  the 
system  have  been  developed,  but  final  implementation  of  the  system  is  still  ongoing. 
Once  the  system  is  fully  operation  additional  testing  should  be  performed  in  order  to 
verify  the  completed  system's  performance.  Although  the  laboratory  results  indicate 
that  the  system  is  capable  of  meeting  all  of  the  design  criteria  except  for  the  required 
resolution  on  the  Pan  axis,  the  system  must  be  further  tested  in  a  non-laboratory  envi¬ 
ronment.  “...The  proof  of  a  good  design  rests  in  the  ability  of  the  system  to  function  in 
the  outside  world. ”  [Ref  21] 

B.  RECOMMENDATIONS  FOR  FURTHER  WORK 

There  are  several  areas  for  follow-on  work  with  this  project.  Some  possibilities  are: 

•  Incorporate  the  measurement  system's  output  into  the  video  image  being  created 
by  the  video  camera.  This  would  permit  a  permanent  record  of  the  position  infor¬ 
mation  to  be  stored  with  the  video  image  and  would  facilitate  identification  of  the 
image  at  a  later  date. 

•  Design  and  build  an  automatic  feedback  control  system  for  the  camera. 

•  Implementation  of  a  second  video  camera  at  the  NPS,  together  with  the  NPS 
modified  IRSTD,  would  permit  triangulation  of  a  target  and  would  consequently 
provide  range  information  which  is  not  currently  available.  This  information  could 
provide  valuable  additional  information  to  those  who  are  developing  the  signal 
processing  algorithms. 
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APPENDIX  A.  SCHEMATIC  DIAGRAMS 
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iQacuffltnc  >Nunaer 
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iocum#nt  Nu»o«r* 


locumant  Nuwotr 

CAMCP*  NPU  (PAN> 


75 


IN»d)  X rwi.no  n*H  roSHro 
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Size  Oocunint  Nu«o«r 

a  CAMCP*  *P(J  INPUT  (TILT 


77 


\Z9  OocuMnc  Mu"iO»r 
A  CA*eWA  MPU  (TtUTI 
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iCocumanc  Nuiko «r 
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APPENDIX  C.  MICROPROCESSOR  PROGRAMS 


A.  GENERAL 

Sections  B  and  C  of  this  Appendix  are  the  listing  files  for  the  two  MPU  programs 
written  for  the  signal  processor  subsystems.  The  theory  of  operation  of  the  two  pro¬ 
grams  is  identical  and  is  most  clearly  described  by  Figure  31.  The  detailed  operation 
of  the  Initialization  ,  Mode  Change,  Blink,  Output  Display  and  Hysteresis  Modify  rou¬ 
tines  is  described  by  the  comments  which  accompany  each  of  the  programs.  In  addition 
to  the  detailed  description  provided  by  the  program  comments,  the  operation  of  the 
Count  Routine  is  also  explained  in  Chapter  IV. 


87 


B.  PAN 


1  TTL  POSITION  DETERMINING  PROGRAM  (AZIMUTH) 

2  *  LATEST  REVISION  9  NAT  69 

3  *  PILE  NAME  PAN. ASM 

A  ** 

5  *«  PROGRAM  DESCRIPTION 


6 

•* 

7 

** 

8 

*« 

9 

I/O  REGISTER  ADDRESSES 

10 

*♦ 

11 

0000 

PORTA 

EOU 

SOOOO 

I/O  PORT  A 

12 

0001 

PORTS 

EQU 

80001 

I/O  PORT  B 

13 

0002 

PORTC 

EOU 

80002 

I/O  PORT  C 

14 

0003 

PORTD 

EQU 

S0003 

INPUT  PORT  D 

15 

** 

16 

**  DATA  DIRECTION  REGISTER  OFFSET 

17 

** 

16 

0004 

DDR 

EQU 

4 

(eg.  DOR  FOR  PORT  A  IS  PORTA+ODR  ) 

19 

** 

20 

**  OTHERS 

21 

•* 

22 

0008 

TIMER 

EQU 

$0008 

EIGHT  BIT  TIMER  REGISTER. 

23 

0009 

TCR 

EOU 

80009 

TIMER  CONTROL  REGISTER. 

24 

OOOA 

MR 

EQU 

SOOOA 

MISCELLANEOUS  REGISTER. 

25 

0010 

RAM 

EQU 

$0010 

START  OF  ON-CHIP  RAM(112  -  31  FOR  STACK) 

26 

0080 

2R0H 

EOU 

$0080 

PAGE  ZERO  OF  ROM. 

27 

0100 

ROM 

EOU 

$0100 

START  OF  MAIN  ROM. 

26 

0F38 

NOR 

EOU 

S0F38 

MASK  OPTION  REGISTER. 

29 

OFFS 

INTRPT 

EQU 

S0FF8 

LOCATION  OF  INTERRUPT  VECTORS. 

30 

1000 

MEMSIZ 

EQU 

$1000 

MEMORY  ADDRESS  SIZE. 

31 

*• 

32 

•*  EQUATES 

33 

•• 

34 

0001 

■1T0 

EQU 

1 

35 

0002 

BIT1 

EOU 

2 

36 

0004 

BIT2 

EQU 

4 

37 

0008 

BITS 

EQU 

8 

38 

0010 

BIT4 

EOU 

16 

39 

0020 

BITS 

EQU 

32 

40 

0040 

BIT6 

EQU 

64 

41 

0080 

B1T7 

EQU 

128 

42 

** 

43 

0000 

BO 

EQU 

0 

44 

0001 

81 

EQU 

1 

45 

0002 

B2 

EQU 

2 

46 

0003 

83 

EQU 

3 

47 

0004 

B4 

EQU 

4 

48 

0005 

B5 

EQU 

5 

49 

0006 

B6 

EQU 

6 

50 

0007 

B7 

EOU 

7 

51 

•• 

52 

*•  EQUATES  FOR 

THE  TIMER  CONTROL  REGISTER 

53 

•• 

54 

55 

0007 

TIR 

EQU 

7 

TIMER  INTERRUPT  REOUEST.  1  ■  REQUEST,  0  *  NO  REO 

56 

0006 

TIM 

EQU 

6 

TIMER  INTERRUPT  MASK.  1  -  DISABLED,  0  »  ENABLED. 

57 

0005 

TIN 

EQU 

5 

EXTERNAL  OR  INTERNAL  CLOCK  SOURCE.  1  «  EXT,  0  « 

58 

0004 

TEE 

EQU 

4 

EXTERNAL  CLOCK  ENABLE.  NOT  USED. 

59 

0003 

PSC 

EQU 

3 

PRESCALER  CLEAR.  NOT  USED. 

60 

0002 

PS2 

EQU 

2 

<PS2)  -- 

61 

0001 

PS1 

EQU 

1 

(PS1)  |--  PRESCALER  SELECT  BITS. 
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62 

0000 

PSO 

EQU 

63 

+# 

64 

•«  EQUATES  1 

65 

*»* 

66 

MM 

67 

** 

68 

0007 

UD 

EQU 

69 

0006 

MOO  32 

EQU 

70 

0005 

FLASH 

EQU 

71 

0004 

POSCT 

EQU 

72 

0003 

L  SET 

EQU 

73 

0002 

NEGTIV 

EQU 

74 

75 

76 

77 

78 

79 

80 
81 
82 

83 

84 

85 

86 

87 

88 

89 

90 

91 

92 

93 

94 

95 

96 

97 

98 

99 


104 

105 

106 

107 

108 

109 

110 
111 
112 

113 

114 

115 

116 

117 

118 

119 

120 


(PSO) 


7  COUNT  DIRECTION?  1  -  UP,  0 

6  IS  'BINCT'  MODULO  32?  1  ■  YES,  0  ■  NO. 

5  BLINK  THE  DISPLAY?  1  -  YES,  0  ■  NO. 

4  DISPLAY  POSITION  OR  COUNT?  1  »  POS,  0  ■  COUNT. 

3  VALUE  OF  'NODE, PORTO'  LAST  TINE. 

2  IS  'SCDCT'NEGATIVE  NUMBER?  1  ■  YES,  0  >  NO. 

1  NOT  USED. 

0  NOT  USED. 


**  I/O  EQUATES  AND  DESCRIPTIONS. 
*** 

**• 

***  PORT  A  (I/O) 


***  BIT 
••• 


♦  - • 

| 

BCD  DIGIT 

- ♦- ■ 

#4 

| 

- 

BCD  DIGIT 

13 

-♦ 

I 

| 

D4  | 

C4  j 

B4  | 

A4  j 

D3 

j  C3  j 

B3 

| 

A3 

! 

7 

6 

5 

4 

3 

2 

1 

0 

PORT  B  (1/0) 

♦ - «. - 

|  DISPLAY  CONTROL  • 

♦ . ♦ . ♦- . ♦- 

|  OECPT  |  POSTI V| 


***  BIT 
**» 


100 

0007 

DECPT 

EQU 

101 

0006 

POSTIV 

EQU 

102 

*«* 

103 

0004 

BLANK 

EQU 

*** 

*»* 

*** 

*** 


••• 

••• 


7 

6 


PORT  C  (I/O) 

- + . 


- . + . ♦ . + . + 

| BCD  DIGIT  #5  (MOST  SIGNIFICANT)! 

- -+ . ♦ . * . * — - — ♦ 

|  BLANK  |  D5  |  C5  |  B5  |  A5  | 

-♦ . ♦ . ♦ . + . ♦ . ♦ . ♦ 

5  4  3  2  1  0 

TO  DISPLAY  THE  DECIMAL  POINT. . .DECPT  IS  CLEARED 
USED  TO  DISPLAY  NEGATIVE  SIGN. . .CLEARED  TO  SHOW 
MINUS  SIGN. 

TO  BLANK  DIGITS  2  AND  3... CLEAR  BLANK. 

DIGITS  4  AND  5  ARE  ALWAYS  BLANKED. 

DIGIT  1  IS  NEVER  BLANKED. 


- + - ♦- 

BCD  DIGIT  #2 
- ♦ - +- 


. ♦ . . ♦ 

| BCD  DIGIT  #1( LEAST  SIGNIFICANT)! 


|  D2  |  C2  |  B2  |  A2  |  D1  |  Cl  |  B1  |  A1 


BIT 


PORT  D  (INPUT  ONLY) 
♦■••• — ♦ - ♦ - 


121 

*♦* 

♦ - 

- 

- •••♦ . 

122 

***  BIT 

7 

6  5  4 

3 

2  1 

0 

123 

**• 

124 

0007 

CH  A 

EQU 

7 

INOICATES  THE 

STATUS  OF 

CHANNEL  A. 

125 

0006 

INT2 

EQU 

6 

INTERRUPT  #2. 

USED  TO  CHANGE  DISPLAY 

MOOES. 

126 

0005 

CH  B 

EQU 

5 

INDICATES  THE 

STATUS  OF 

CHANNEL  B. 

127 

0004 

FLWCT 

EQU 

4 

USED  TO  PUT  THE  PROGRAM 

IN  A  MOOE  THAT 

WILL  ALLOW 

89 


128 

129 

130 

131 

0003 

*** 

SET 

*** 

EQU 

3 

'HYST'  TO  BE  INCREMENTED. 

INCREMENTS  'HYST'  WHEN  TOGGLED  AND  FUNCT  IS  LOU. 

132 

133 

** 

* 

134 

** 

RAN  VARIABLES  * 

13S 

** 

* 

136 

*#***»*! 

137 

** 

138 

**  RESERVE  MEMORY  SPACE 

FOR  TNE  PROGRAM  VARIABLES. 

139 

** 

140 

0000 

DATA 

141 

** 

142 

** 

143 

0000 

ABSOLUTE  (ABSOLUTE  ADDRESSING  USED  HERE  TO  RELATIVE  DIRECTIVE) 

144 

145 

0010 

ORG 

RAM 

START  OF  RAN. 

146 

** 

147 

***  BINARY  COUNT. 

148 

0010 

B1NCT 

RMB 

3 

149 

0010 

HIBIN 

EQU 

BINCT 

HI  BYTE. 

150 

0011 

MIDBIN 

EQU 

BINCT+1 

MIDDLE  BYTE. 

151 

0012 

L08IN 

EQU 

BINCT+2 

LO  BYTE. 

152 

** 

153 

***  POSITION  POINTERS. 

154 

0013 

PTR 

RMB 

4 

EACH  BYTE  POINTS  TO  A  POSITION  IN  THE 

155 

** 

TABLE  THAT  CONTAINS  ONE  OR  TWO  DIGITS 

156 

•* 

OF  THE  BCD  POSITION. 

157 

0013 

PTR4 

EQU 

PTR 

MOST  SIGNIFICANT  DIGITS. 

158 

0014 

PTR3 

EQU 

PTR+1 

159 

0015 

PTR2 

EQU 

PTR*2 

160 

0016 

PTR1 

EQU 

PTR+3 

LEAST  SIGNIFICANT  DIGIT. 

161 

** 

162 

***  COUNT  POINTERS. 

163 

0017 

CTPTR 

RMB 

3 

EACH  BYTE  POINTS  TO  A  POSITION  IN  THE 

164 

** 

TABLE  THAT  CONTAINS  TUO  OF  THE  DIGITS 

165 

** 

IN  THE  BCD  COUNT. 

166 

0017 

CTPTR3 

EQU 

CTPTR 

MOST  SIGNIFICANT  DIGITS. 

167 

0018 

CTPTR2 

EQU 

CTPTR*1 

168 

0019 

CTPTR 1 

EQU 

CTPTR+2 

LEAST  SIGNIFICANT  DIGITS. 

169 

** 

170 

***  BCD 

POSITION  IN  DEGREES. 

171 

001A 

OEGRES 

RMB 

4 

172 

001A 

HUNOEG 

EQU 

DEGRES 

CONTENTS  X  100.000 

173 

001 B 

ONEOEG 

EQU 

DEGRES+1 

CONTENTS  X  1.000 

174 

001C 

HUNDTH 

EQU 

DEGRES+2 

CONTENTS  X  0.010 

175 

0010 

T MOUTH 

EQU 

DEGRES+3 

*  CONTENTS  X  0.001 

176 

*** 

177 

••• 

POSITION  IN  DEGREES 

178 

** 

179 

***  BCD 

COULT. 

180 

001E 

BCOCT 

RMB 

3 

181 

001E 

TENTHO 

EQU 

BCOCT 

CONTENTS  X  10,000 

182 

001F 

HUNORD 

EQU 

BCDCT+1 

CONTENTS  X  100 

183 

0020 

TENONE 

EQU 

BCDCT+2 

+  CONTENTS  X  1 

184 

*** 

185 

*** 

NUMBER  OF  PULSES  COUNTED 

186 

*** 

187 

***  HYSTERESIS  COUNTER. 

POINTS  TO  A  NUMBER  IN  THE  TABLE  THAT  IS  THE 

188 

**• 

AMOUNT 

OF  HYSTERESIS  PRESENT  IN  TK  SYSTEM.  INITIALIZED  TO  7. 

189 

0021 

HYSTPT 

RMB 

1 

190 

•* 

191 

***  POSITION  INCREMENT. 

CONTAINS  A  NUMBER,  THAT  WHEN  MULTIPLIED  BY  0.001 

192 

*** 

IS  THE 

NUMBER  OF  DEGREES  THAT  THE  POSITION  COUNTER  (BCDPOS)  IS 

193 

•** 

TO  BE 

INCREMENTED  OR  DECREMENTED  DURING  PROGRAM  EXECUTION. 

90 


194 

195 

196 

197 
196 

199 

200 
201 
202 

203 

204 

205 

206 

207 

208 

209 

210 
211 
212 

213 

214 

215 

216 

217 

218 

219 

220 
221 
222 

223 

224 

225 

226 

227 

228 

229 

230 

231 

232 

233 

234 

235 

236 

237 


0022 


0023 


0024 


0025 

0026 


0027 


***  THE  VALUE  OF  'POSING',  DETERMINED  EXPERIMENTALLY,  SNOULO  BE 
***  7.0312.  SINCE  THE  PROGRAM  IS  DESIGNED  UORK  WITH  INTEGERS  ONLY 

TNIS  NUMBER  IS  ROUNDED  TO  7.  TO  REDUCE  THE  CUMULATIVE  EFFECT  OF 
***  THE  ROUND  OFF,  EVERY  32  COUNTS  'POStNC'  IS  SET  EQUAL  TO  8.  TNIS 

***  AGAIN  LEADS  TO  SOME  CUMULATIVE  ERROR  THAT  IS  ACCOUNTED  FOR  BY 

***  SETTING  'POSINC'  TO  7  INSTEAD  OF  8  WHEN  THE  COUNT  REACHES  A 
***  VALUE  OF  16384  (2A14). 

POSINC  RM8  1 
**» 

*»*  HYSTERESIS  VARIABLES.  USED  TO  ELIMINATE  THE  EFFECTS  OF  BACKLASH  ON 
«*  THE  POSITION  MEASUREMENTS. 


HYST 

*** 

HYSTCT 


1  THE  THRESHHOLD  VALUE  DETERMINED 

EXPERIMENTALLY. 

1  CURRENT  AMOUNT  OF  HYSTERESIS  MEASURED. 


STATUS  BYTE.  USED  TO  KEEP  TRACK  OF  WHAT  IS  GOING  ON. 


STAT 

LSTAT 


1  CURRENT  STATUS. 

1  PREVIOUS/LAST  STATUS.  USED  TO  KEEP  TRACK  OF 

L  SET  ONLY. 


***  TIMER  COUNTER.  USED  IN  CONJUNCTION  WITH  THE  TIMER  PRESCALER  AND  THE 
***  TDR  TO  KEEP  TRACK  OF  ONE  SEC.  INTERVALS.  USED  IN  BLINKING  THE 
***  DISPLAY.  INITIALLY  SET  TO  31,  WHEN  THE  'FLASH'  BIT  OF  'STAT' 

IS  SET.  T1MCT  IS  DECREMENTED  EACH  CLOCK  INTERRUPT  (APPROX.  31 
***  TIMES  PER  SEC).  RESET  TO  31  WHEN  CONTENTS  GO  TO  ZERO. 

WHEN  (TIHCT)*0  THE  DISPLAY  WILL  TOGGLE. 


1 


238 

0000 

CODE 

239 

** 

240 

0080 

ORG 

ZROM 

241 

** 

242 

0080 

RELATIVE 

243 

** 

244 

0080 

RESTRT 

EOU 

S 

245 

*** 

246 

** 

247 

******* 

'*****•*•< 

ItMMM 

248 

** 

249 

*** 

INITU 

250 

••* 

251 

**• 

252 

0080 

9B 

SEI 

253 

0081 

9C 

RSP 

254 

•** 

255 

0082 

AE  10 

LOX 

BBINCT 

256 

0084 

7F 

CLRIT 

CLR 

,x 

257 

0085 

5C 

INCX 

258 

0086 

A3  27 

CPX 

NTIMCT 

259 

0088 

23  FA 

BLS 

CLRIT 

*•» 

••• 

TIMCT  RMB 
** 

ENDS 


**  PAGE  ZERO  ROM 

*•  * 
************************************************************************ 
#« 

**  INITIALIZATION  ROUTINE. 

•• 

•• 


PAGE  ZERO  ROM. 

RELATIVE  ADDRESSING  MUST  BE  USED  FOR  THE  BRANCH. 

THIS  IS  THE  ENTRY  POINT  WHEN  THE  RESET 
SWITCH  IS  PUSHED. 


INITIALIZE  THE  PC  AND  CLEAR  RAM. 


SET  INTERUPT  TO  AVOID  INTERUPTION  AND 
RESET  THE  STACK  POINTER.  JUST  IN  CASEI 

CLEAR  ALL  OF  THE  VARIABLES  BETWEEN 
'BINCT'  AND  'TIMCT'  (INCLUSIVE). NOTE 
THAT  THIS  SETS  THE  COUNTER  AND  THE  POS¬ 
ITION  TO  ZERO.  THIS  MEANS  THAT  ROTATION 
SHOULD  START  IN  AN  INCREASING  (CW) 
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260 

261 

262 

263 

264 

265 

2 66 


008A 


293 

294 

295 

296 

297 

298 

299 

300 

301 

302 

303 

304 

305 

306 

307 

308 

309 

310 

311 

312 

313 

314 

315 

316 

317 

318 

319 

320 

321 

322 

323 

324 

325 


00A3  A6  47 


00A5  B7  09 


OOA7  A6  FF 
OOA9  B7  08 


00AB  A6  IF 
OOAD  B7  27 


ABSOLUTE 


DIRECTION  FROM  THE  MOST  CCW  POSITION 
AFTER  A  RESET. 

BACK  TO  ABSOLUTE  ADDRESSING. 


267 

*** 

ESTABLISH  I/O  PORTS. 

268 

*** 

269 

OOSA 

A6  FF 

LDA 

#-1 

PORTS  A,B,C  ARE  CONFIGURED  AS 

270 

008C 

87  04 

STA 

PORTA+OOR 

ALL  OUTPUT.  PORT  D  IS  ALL  INPUT 

271 

008E 

B7  05 

STA 

P0RTB4D0R 

SO  THERE  IS  NO  MASK  TO  SET. 

272 

0090 

87  06 

STA 

PORTC*ODR 

273 

274 

*** 

275 

0092 

CD  03  4E 

JSR 

OUTCT 

COUNT  IS  TO  BE  DISPLAYED  INITIALLY. 

276 

*** 

277 

****** 

278 

#•* 

SET  UP  THE  STATUS  REGISTER. 

279 

*** 

280 

0095 

A6  08 

LDA 

#100001000 

-- 

281 

0097 

B4  03 

AND 

PORTO 

|-->  SET  UP  'L  SET*  BIT  OF  'STAT* . 

282 

0099 

B7  25 

STA 

STAT 

-- 

283 

*** 

284 

009B 

1C  25 

BSET 

MOO  32, STAT 

0  IS  MODULO  32. 

285 

** 

286 

********************* ************************ 

287 

*** 

288 

*** 

INITIALIZE  HYSTCT. 

289 

*** 

290 

0090 

A6  08 

LDA 

#08 

291 

009F 

87  23 

STA 

HYST 

292 

00A1 

B7  21 

STA 

HYSTPT 

•• 


SET  UP  THE  TIMER  FOR  A  4  MHZ  CRYSTAL  /  4  «  1  MHZ  CLOCK. 

NOTE:  THE  MASK  OPTION  REGISTER  IS  IN  RON.  IT  IS  SET  UP  AT 
THE  END  OF  THE  PROGRAM. 


SET  UP  THE  TCR. 


LDA 


MIT6+8IT2+BIT1+BIT0 
***  (TIN>|(PS2)(PS1)(PS0) 

•••(DISABLE  INTERRUPT) j (PRESCALE  BY  128) 
••• 

STA  TCR 

•** 

*••  SET  UP  THE  TIMER. 

•** 

LDA  #255 

STA  TIMER 


1  MHZ/( 128*255)  «  30.6  (APPROX.  31) 


OOAF  ID  OA 


INITIALIZE  THE  TIMER  COUNTER. 

LDA  #31  PROVIDES  FOR  1  SEC.  BLINK  INTERVAL. 

STA  TIMCT  FOR  2  SEC.  INTERVAL  JUST  USE  TINECT«62,  etc. 


SET  UP  MISCELLANEOUS  REGISTER. 
BCLR  B6.MR  ENABLES  THE  SECOND  INTERRUPT. 
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326 

** 

327 

** 

328 

0081 

9A 

CL  I 

CLEAR  THE 

INTERRUPT  MASK  TO  GET  STARTED. 

329 

330 

0082 

RELATIVE  RELATIVE  ADDRESSING  MUST  BE  USED  FOR  THE 

331 

*** 

REMAINDER  OF  THE  PROGRAM. 

332 

*** 

********************** 

>***•••*** ******* 

333 

******** 

******* 

336 

*# 

335 

**  WAIT 

LOOP. 

EXECUTES,  UNTIL  AN 

INTERRUPT  OCCURS. 

336 

** 

337 

0082 

09  03  08 

PAUSE 

BRCLR 

FUNCT.PORTD, CHHYST  WANT  TO  CHANGE  HYST7 

338 

** 

YES... DO  TO  CHHYST. 

339 

0085 

06  03  04 

BRSET 

SET.PORTD.SBIT 

NO. . . 'SET, PORTO'  SET? 

340 

0088 

17  25 

BCLR 

L  SET , STAT 

NO... CLEAR  *L  SET, STAT' 

341 

00BA 

20  F6 

BRA 

PAUSE 

AND  LOOP. 

342 

ooec 

16  25 

S8IT 

BSET 

L  SET, STAT 

YES... SET  *L  SET, 

STAT' 

343 

OOBE 

20  F2 

BRA 

PAUSE 

AND. ..LOOP 

344 

** 

345 

******** 

******* 

!*•*** 14  A  4******* 

346 

** 

347 

**  HYSTERESIS  MODIFICATION  ROUTINE 

.  PERMITS  MODIFICATION  OF  THE 

348 

**  HYSTERESIS  BUFFER  WITHOUT  REPROGRAMMING. 

349 

** 

350 

OOCO 

A6  40 

CHHYST 

LOA 

B8IT6 

DISABLE  TIMER  INTERRUPT. 

351 

00C2 

B7  09 

STA 

TCR 

352 

*** 

353 

00C4 

A6  08 

LOA 

#100001000 

SAVE  'L  SET' 

354 

00C6 

B4  25 

AND 

STAT 

INTO 

355 

00  CS 

B7  26 

STA 

LSTAT 

'LSTAT'. 

356 

OOCA 

A6  08 

LOA 

#*00001000 

357 

oocc 

84  03 

AND 

PORTO 

‘SET, PORTO'  -•»  ACCUMULATOR 

358 

OOCE 

81  26 

CMP 

LSTAT 

HAS  THE  SET  SWITCH  BEEN  CHANGED? 

359 

0000 

27  15 

BEO 

OISPLA 

360 

•** 

YES... 

361 

0002 

A6  08 

LOA 

#*00001000 

-- 

362 

0004 

88  25 

EOR 

STAT 

1  *  - >CHANGE  'L  SET, STAT', 

363 

0006 

87  25 

STA 

STAT 

-- 

364 

0008 

3C  23 

INC 

HYST 

THEN  INCREMENT  THE  HYSTERESIS 

365 

000 A 

3C  21 

INC 

HYSTPT 

POINTER  AND  'HYST'... 

366 

*•* 

367 

OOOC 

86  21 

LOA 

HYSTPT 

368 

OODE 

A1  19 

CMP 

#25 

-- 

369 

OOEO 

23  05 

BLS 

OISPLA 

-- 

370 

--  BUT  NOT  ABOVE  25. 

371 

00E2 

4F 

CLRA 

THEN-**> 

372 

00E3 

87  23 

STA 

HYST 

-- 

373 

00E5 

87  21 

STA 

HYSTPT 

-- 

374 

**• 

375 

00E7 

A6  00 

OISPLA 

LOA 

#*00000000 

NO...  JUST . > 

376 

00E9 

B7  00 

STA 

PORTA 

-• 

377 

OOEB 

A6  CO 

LOA 

#*11000000 

-- 

378 

OOED 

87  01 

STA 

PORTB 

\ 

/ 

379 

*♦* 

-•  DISPLAY  CURRENT  'HYST'. 

OOEF 

BE  21 

LDX 

HYSTPT 

-- 

381 

00F1 

D6  03  BE 

LOA 

TABLE, X 

-- 

382 

OOF4 

87  02 

STA 

PORTC 

383 

•«* 

IS  'HYST'  SETTING  COMPLETE? 

384 

00F6 

09  03  C7 

BRCLR 

FUNCT.PORTD, CHHYST 

NO...  KEEP  CHECKING  < 

SET'. 

385 

00F9 

08  25  05 

BRSET 

POSCT, ST AT, SHOPOS 

YES...  RESET  THE  DISPLAY. 

386 

OOFC 

CO  03  4E 

JSR 

OUTCT 

387 

00  FF 

20  03 

BRA 

DUNCHG 

388 

••• 

389 

0101 

CO  03  68 

SHOPOS 

JSR 

OUTPOS 

390 

*** 

391 

0104 

08  25  04 

DUNCHG 

BRCLR 

FLASH , STAT, NO_I NT 

IF  THE  DISPLAY  IS  TO  BLINK... 
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392 

0107 

A6  07 

LDA 

8BIT2+8IT1+BIT0 

ENABLE  TIMER  INTERRUPT  AND  RESET 

393 

0109 

87  09 

STA 

TCR 

TIMER  PRESCALER 

394 

395 

396 

397 

0108 

20  A5 

MO  JUT 

*** 

+* 

BRA 

PAUSE 

PRIOR  TO  RETURNING. 

398 

399 

400 

401 

402 


**  MAXIMUM  EXECUTION  TINE  FOR  THE  REMAINDER  OF  THE  PROGRAM  OCCURS 
**  IF  THE  COUNTER  ROTATES  THROUGH  ZERO  AS  THE  DISPLAY  NODE  IS  CHANGED 
«  FROM  THE  SLINKING  NODE  TO  THE  COUNT  NODE  AT  THE  SANE  TINE  THAT  THE 
**  BLINKING  ROUTINE  IS  CAUSING  THE  DISPLAY  TO  TOGGLE  TO  SHOW  THE 
**  POSITION  IN  DEGREES. 


403 

•* 

MAXIMUM  EXECUTION  TINE  ■  140  ♦  184  ♦  708  ■  1032  CLOCK  CYCLES. 

404 

******* 

405 

** 

406 

**  MODE 

CHANGE  ROUTINE.  CHANGES  THE  DISPLAY  NODE  FROM 

407 

** 

COUNT 

•>  POSITION  •>  BLINKING  •>  COUNT  -> _ (ETC.) 

408 

*# 

MAXIMUM  EXECUTION  TINE  OF  181  CLOCK  CYCLES  OCCURS  WHEN  THE 

409 

** 

DISPLAY  NODE  IS  CHANGED  FROM  DISPLAYING  THE  COUNT  TO  DISPLAYING 

410 

** 

THE  POSITION  (IN  DEGREES). 

411 

** 

IF  THE  DISPLAY  IS  CHANGED 

FROM  BLINKING  TO  A  COUNT  DISPLAY 

412 

** 

EXECUTION  TINE  IS  140  CLOCK  CYCLES. 

413 

*• 

414 

0100 

IF 

OA 

CNMODE 

BCLR 

B7,MR 

AVOID  REPEATED  INTERRUPTS. 

415 

•+ 

416 

010F 

OA 

25  10 

BRSET 

FLASH, ST AT.DIS  CT 

IF  FLASHING,  DISPLAY  COUNT... 

417 

0112 

09 

25  07 

BRCLR 

POSCT.STAT, DISPOS 

IF  SHOWING  COUNT,  DISPLAY  POSITION... 

418 

0115 

1A 

25 

BSET 

FLASH, STAT 

ELSE,  BLINK. 

419 

** 

420 

0117 

A6 

07 

LOA 

MIT2+BIT1+BIT0 

ENABLE  TIMER  INTERRUPT  AND  RESET 

421 

0119 

B7 

09 

STA 

TCR 

TIMER  PRESCALER. 

422 

011B 

80 

RT I 

423 

*• 

424 

one 

18 

25 

DISPOS 

BSET 

POSCT.STAT 

425 

01 1 E 

CO 

03  68 

JSR 

OUT POS  | 

|--  DISPLAY  CURRENT  POSITION,  AND  WAIT. 

426 

0121 

80 

RT1 

-- 

427 

** 

428 

0122 

A6 

47 

DIS_CT 

LDA 

«81T6*BIT2+BITHBIT0  DISABLE  TIMER  INTERRUPT  AND  RESET 

429 

0124 

B7 

09 

STA 

TCR 

TIMER  PRESCALER. 

430 

0126 

19 

25 

BCLR 

POSCT.STAT 

431 

0128 

IB 

25 

BCLR 

FLASH, STAT 

432 

** 

-*  DISPLAY  CURRENT  COUNT.  AND  WAIT. 

433 

012A 

CO 

o 

w 

•r* 

m 

JSR 

OUTCT 

434 

0120 

80 

RTI 

-- 

435 

** 

436 

A*********************************************************************** 

437 

** 

438 

**  BLINK  ROUTINE.  INTERRUPT  ROUTINE  TO  CHANGE  THE  DISPLAY  FROM  POSITION 

439 

** 

TO  COUNT  OR  VICE  VERSA  EVERY  31  ST  TIMER  INTERRUPT  IF  THE 

440 

** 

'FLASH 

'  BIT  OF  'STAT'  IS  SET. 

441 

** 

MAXIMUM  EXECUTION  TIME  OF 

184  CLOCK  CYCLES  OCCURS  WHEN  THE 

442 

•• 

DISPLAY  IS  TOGGLED  FROM  A  COUNT  DISPLAY  TO  A  POSITION  DISPLAY. 

443 

** 

444 

01 2E 

BLINK 

EQU 

S 

445 

01 2E 

OF 

09  DC 

BRCLR 

TIR.TCR.CHMODE 

IF  THE  INTERRUPT  WAS  NOT  A  TIMER 

446 

•• 

INTERRUPT  IT  MUST  BE  FROM  INT2. 

447 

** 

448 

0131 

IF 

09 

BCLR 

TIR.TCR 

AVOID  REPEATED  TIMER  INTERRUPTS. 

449 

*• 

450 

0133 

3A 

27 

DEC 

TIMCT 

IF  THERE  HAVE  BEEN  31  TIMER 

451 

0135 

27 

01 

BEQ 

CHGOIS 

INTERRUPTS  (1  SEC),  IT'S  TINE  TO 

452 

** 

CHANGE  THE  DISPLAY. 

453 

0137 

80 

RTI 

OTHERWISE,  IT'S  BACK  TO  WORK. 

454 

BMP 

455 

0138 

A6 

IF 

CHGOIS 

LDA 

#31 

RESET  TIMCT  TO  31  (1  SEC.  INTERVAL). 

456 

013A 

B7 

27 

STA 

TIMCT 

457 
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458 

013C 

B6  25 

LDA 

STAT 

459 

013E 

A8  10 

EOR 

8X00010000 

460 

0140 

B7  25 

STA 

STAT 

461 

** 

462 

0142 

08  25  04 

BRSET 

POSCT, STAT .POSOUT 

463 

#* 

464 

******* 

***** 

CHANGE  THE  DISPLAY 

465 

** 

466 

0145 

CD  03  4E 

JSR 

OUTCT 

467 

0148 

80 

RTI 

468 

** 

469 

******* 

***** 

OR  HAVE  THE  DISPLAY 

470 

** 

471 

0149 

CD  03  68 

POSOUT 

JSR 

OUTPOS 

472 

014C 

80 

RT! 

I**  CHANGE  'POSCT'  SIT  OF  'STAT'. 


COUNT  ROUTINE. 

WHEN  A  COUNT  IS  RECEIVED  THIS  IS  THE  ENTRY  POINT  . 

MAXIMUM  EXECUTION  TINE  OF  708  CLOCK  CYCLES  OCCURS  WHEN  THE 
COUNTER  ROTATES  CCW  THROUGH  ZERO  AND  THE  POSITION  (IN  DEGREES) 
IS  BEING  DISPLAYED. 


**  CURRENT  DIRECTION  OF  ROTATION  IS  DETERMINED  BY  INSPECTING  THE  STATUS 
**  OF  'CH  A'  AND  'CH  B'.  THE  FOUR  POSSIBILITIES  AND  THE  ASSOCIATED 
**  DIRECTION  OF  ROTATION  ARE  AS  SHOWN  BELOW.  NOTE  THAT  THIS  SCHEME 
•*  PREVENTS  MULTIPLE  OSCILLATIONS  ABOUT  A  SINGLE  POINT  FROM 
**  REPEATEDLY  INCREMENTING  OR  DECREMENTING  THE  COUNTER. 


♦ . 

1  CH_A 

1 

CH  B 

DIRECTION 

OF  ROTATION 

COUNT  THE  PULSE?  | 
1 

LO 

LO 

CU 

NO 

LO 

HI 

CCW 

YES 

HI 

LO 

CCW 

NO 

HI 

HI 

CW 

YES 

FIRST  SEE  IF  WE  ARE  SUPPOSED  TO  COUNT  THIS  INTERUPT. 


501 

014D 

COUNT 

EQU 

S 

502 

014D 

OA  03  01 

BRSET 

CH  B,PORTD,OKCT 

IF  CH  B  IS  LO  WE  DON'T  COUNT  THE 

503 

0150 

80 

RTI 

INTERRUPT. 

504 

** 

505 

•  IF  THE  INTERRUPT  IS  VALID  UPDATE  'STAT'.  ************ 

506 

** 

507 

0151 

A6  7F 

OKCT 

LDA 

8X01111111 

508 

0153 

B4  25 

AND 

STAT 

SAVE  ALL  OF  THE  OLD  ’STAT'  EXCEPT  THE 

509 

0155 

B7  25 

STA 

STAT 

DIRECTION  OF  ROTATION. 

510 

0157 

A6  80 

LDA 

8X10000000 

511 

0159 

B4  03 

AND 

PORTD 

’CH  A, PORTD'  INDICATES  THE  DIRECTION 

512 

* 

OF  ROTATION  AND  BECOMES  ’UD.STAT'. 

513 

01 5B 

BA  25 

ORA 

STAT 

ADO  THE  RESULTS  TO  GET 

514 

0150 

B7  25 

STA 

STAT 

THE  NEW  'STAT'. 

515 

** 

516 

**  DECIDE  IF 

THE  "SLACK"  DUE  TO  BACKLASH/HYSTERESIS  HAS  BEEN  TAKEN  OUT, 

517 

** 

518 

015F 

OE  25  09 

BRSET 

UD,STAT,HY$TCK 

IF  ROTATING  CU  SEE  BELOW. 

519 

0162 

B6  24 

LDA 

HYSTCT 

ELSE,  SEE  IF  WE  DECREMENT  THIS  TIME. 

520 

0164 

27  60 

BED 

CCW 

IF  HYSTCT-0,  GO  TO  THE  COUNT  DOWN 

521 

** 

ROUTINE. 

522 

0166 

AO  01 

sue 

#1 

ELSE,  DECREMENT  THE  HYSTERESIS  COUNTER, 

523 

0168 

B7  24 

STA 

HYSTCT 
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524 

016A 

80 

RT I 

AND  WAIT  FOR  THE  NEXT  INTERRUPT. 

525 

** 

526 

0168 

86  23 

HYSTCK 

LDA 

NYST 

IF  ROTATING  CU.... 

527 

0160 

81  24 

CMP 

HYSTCT 

AND  NYST  ■  HYSTCT  _ 

528 

016F 

27  03 

BEO 

CU 

COUNT  THE  PULSE  . 

529 

0171 

3C  24 

INC 

HYSTCT 

ELSE,  INCREMENT  THE  HYSTERESIS  COUNTER, 

530 

0173 

80 

RTI 

AND  WAIT  FOR  ANOTHER  PULSE. 

531 

** 

532 

** 

533 

******* 

534 

** 

535 

** 

CLOCKWISE  ROUTINE. 

536 

** 

537 

0174 

cu 

EOU 

$ 

538 

#* 

539 

*** 

540 

******* 

******* 

INCREMENT  THE  BINARY  COUNTER  (BINCTJ.  . . . 

541 

*** 

542 

0174 

86  12 

LDA 

LOBIN  BEGIN  AT  THE  LS8  OF  THE  BINARY  COUNTER. 

543 

0176 

AB  01 

ADO 

*1  LOBIN  *  LOBIN  *  1  ;  CARRY  ->  C.CCR 

544 

0178 

B7  12 

STA 

LOBIN 

545 

♦*+ 

546 

01 7A 

B6  11 

LDA 

MIDBIN 

547 

01 7C 

A9  00 

ADC 

#0 

ADO  THE  CARRY  TO  THE  MIDDLE  BYTE. 

548 

017E 

B7  11 

STA 

MIDBIN 

549 

**• 

550 

0180 

B6  10 

LDA 

HIBIN 

551 

0182 

A9  00 

ADC 

#0 

ADO  THE  CARRY  TO  THE  HIGH  BYTE. 

552 

0184 

B7  10 

STA 

HIBIN 

553 

*** 

554 

#** 

555 

***********  CLR/SET  MOO  32  APPROPRIATELY.  *»»*»*•»**»*»»•*»**** 

556 

*** 

557 

*** 

THE  FOLLOWING  SEVERAL  LINES  OF  CODE  ARE  PRETTY  MESSY.  ALL  THAT 

558 

+** 

IS  BEING  DONE  IS  TO  ENSURE  THAT  THE  SCALE  FACTOR  IS  SET  PROPERLY. 

559 

•*+ 

FOR  THE 

PAN  AXIS  THE 

SCALE  FACTOR  IS; 

560 

*** 

561 

*** 

1  PULSE  •»  0.007097  DEGREES 

562 

*•* 

563 

0186 

B6  12 

LDA 

LOBIN 

IF  THE  LOU  FIVE  BITS  OF  'LOBIN'  ARE  NOT 

564 

0188 

A4  IF 

AND 

#*00011111 

ZERO  THEN  THE  NUMBER  ISN'T  A  MOOULO  32  NUMBER 

565 

018A 

26  OF 

BNE 

NOT  32 

566 

018C 

B6  11 

LDA 

MIDBIN 

IF  THE  LOU  SIX  BITS  OF  'MIDBIN'  ARE  ZERO 

567 

018E 

27  07 

BEO 

MOO 

AND  'HIBIN'  .NE.  ZERO 

568 

0190 

A4  3F 

AND 

#*00111111 

THEN  THE  HUMBER  IS  MODULO  16,384,  AND  UE 

569 

0192 

26  03 

BNE 

NOD 

DON'T  WANT  TO  SET  'MOO  32.STAT',  UNLESS 

570 

0194 

00  11  04 

8RCLR 

B6.MIDBIN.N0T  32  THE  NUMBER  IS  ALSO  NOOULO  32,768. 

571 

*** 

572 

0197 

1C  25 

MOO 

BSET 

MOD  32,STAT 

573 

0199 

20  02 

BRA 

DIRCHK 

574 

**+ 

575 

0198 

ID  25 

NOT  32 

8CLR 

MOO  32, ST AT 

576 

*** 

577 

*•* 

578 

0190 

B6  10 

DIRCHK 

LDA 

HIBIN 

579 

019F 

2B  10 

BMI 

CUNEG 

IF  HIBIN  <  0  ,  WE'RE  ROTATING  CCW  TOWARD 

580 

THE  ORIGIN. 

581 

*** 

582 

01A1 

26  14 

BNE 

CUPOS 

583 

01A3 

86  11 

LDA 

MIDBIN 

ELSE  IF  BINCT  .NE.  0 

584 

01A5 

26  10 

BNE 

CUPOS 

WE'RE  ROTATING  CU 

585 

01A7 

86  12 

LDA 

LOBIN 

AWAY  FROM  THE  ORIGIN. 

586 

01A9 

26  OC 

BNE 

CUPOS 

587 

588 

*** 

ELSE,  WE'VE  ROTATED  CU  THROUGH  THE  ORIGIN. 

589 

0  MB 

15  25 

BCLR 

NEGTIV.STAT 

CLR  NEGATIVE  SIGN. 
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590 

01AD 

AE 

13 

IDX 

BPTR4 

-- 

591 

01AF 

7F 

CLRIT2 

CLR 

.X 

•• 

592 

0180 

5C 

IN  CX 

--RESET  ALL  COUNTERS  AND  DEGRES  TO  ZERO. 

593 

0181 

A3 

10 

CPX 

fTHOUTH 

-- 

594 

0183 

23 

FA 

BLS 

CLRIT2 

-- 

595 

01 B5 

20 

68 

BAA 

UPOUT 

UPOATE  OUTPUT. 

596 

**• 

597 

01 B7 

AD 

74 

CUPOS 

BSR 

ADO BCD 

598 

0189 

CO 

02  6A 

JSR 

IN CPOS 

599 

01 BC 

20 

64 

BRA 

UPOUT 

600 

#** 

601 

01  BE 

CO 

02  CA 

CUNEG 

JSR 

tmacp 

602 

01C1 

CD 

02  6A 

JSR 

INCPOS 

603 

01C4 

20 

5C 

BRA 

UPOUT 

604 

#+* 

605 

** 

606 

******* 

607 

•* 

608 

+* 

COUNTER-CLOCKWISE  ROUTINE. 

609 

** 

610 

01C6 

ecu 

EQU 

$ 

611 

+* 

612 

*** 

613 

CLR/SET  MOO  32  APPROPRIATELY.  ********************* 

614 

*** 

615 

*** 

AGAIN 

SET  THE  SCALE  FACTOR  TO; 

616 

*** 

617 

•** 

1  PULSE  *>  0.007097  DEGREES 

618 

*** 

619 

01C6 

86 

12 

LOA 

L06IN 

IF  THE  LOW  FIVE  BITS  OF  'LOBIN'  ARE  NOT 

620 

01C8 

A4 

IF 

AND 

#*00011111  ZERO  THEN  THE  NUMBER  ISN'T  A  MODULO  32  NUMBER 

621 

01CA 

26 

OF 

BNE 

NO  32 

622 

01CC 

B6 

11 

LDA 

MIDBIN 

IF  THE  LOW  SIX  BITS  OF  'MIDBIN'  ARE  ZERO 

623 

01 CE 

27 

07 

BEO 

MOOLO 

AND  'HIBIN'  .NE.  ZERO 

624 

01D0 

A4 

3F 

AND 

#*00111111  THEN  THE  NUMBER  IS  MODULO  16,384.  AND  WE 

625 

0102 

26 

03 

BNE 

MOOLO 

DON'T  WANT  TO  SET  'MOD  32.STAT',  UNLESS 

626 

01D4 

00 

11  04 

BRCLR 

B6, MIDBIN, NO  32  THE  NUMBER  IS  ALSO  MODULO  32,768. 

627 

*** 

628 

0107 

1C 

25 

MOOLO 

BSET 

MOO  32,  ST  AT 

629 

0109 

20 

02 

BRA 

DECBIN 

630 

*** 

631 

0108 

ID 

25 

NO  32 

BCLR 

MOD  32,  ST  AT 

632 

*** 

633 

*** 

634 

******* 

'*  DECREMENT  THE  BINARY  COUNTER  (BINCT).  **************** 

635 

*** 

636 

01D0 

B6 

12 

DECBIN 

LOA 

LOBIN 

BEGIN  AT  THE  LSB  OF  THE  BINARY  COUNTER. 

637 

01DF 

AO 

01 

SUB 

#1 

LOBIN  *  LOBIN  -  1  ;  BORROW  •>  C.CCR 

638 

01E1 

87 

12 

STA 

LOBIN 

639 

*** 

640 

01E3 

86 

11 

LDA 

MIDBIN 

641 

01E5 

A2 

00 

SBC 

#0 

SUBTRACT  THE  CARRY  FROM  THE  MIDDLE  BYTE. 

642 

01E7 

B7 

11 

STA 

MIDBIN 

643 

*** 

644 

01E9 

B6 

10 

LOA 

HI  BIN 

645 

01EB 

A2 

00 

SBC 

#0 

SUBTRACT  THE  CARRY  FROM  THE  HIGH  BYTE. 

646 

01 E0 

B7 

10 

STA 

HI  BIN 

647 

*** 

648 

01EF 

86 

10 

LDA 

HIBIN 

649 

01F1 

2A 

29 

BPL 

C CUPOS 

IF  HIBIN  .GE.  0  ,  WE'RE  ROTATING  CCW  TOWARD 

650 

•** 

THE  ORIGIN. 

651 

01 F3 

A6 

FF 

LOA 

#-1 

-- 

652 

01 F5 

81 

10 

CMP 

HIBIN 

-- 

653 

01F7 

26 

1C 

BNE 

CCWNEG 

--  ELSE  IF  BINCT  .NE.  -1  , 

654 

01F9 

81 

11 

CMP 

MIDBIN 

—  WE'RE  ROTATING  CCW  AWAY 

655 

01F8 

26 

18 

BNE 

CCWNEG 

--  FROM  THE  ORIGIN. 
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656 

01 FD 

61 

12 

CMP 

L06IN 

-• 

657 

01  FF 

26 

14 

BNE 

CCWNEG 

-- 

656 

*** 

659 

0201 

14 

25 

6SET 

NE6TIV.STAT  ELSE,  UE'VE  GONE  THROUGH  ORIGIN  IN  CCW 

660 

*** 

DIRECTION.  SET  NEGATIVE  SIGN. 

661 

*** 

AND  SET  ALL  COUNTERS  APPROPRIATELY. 

662 

0203 

A6 

03 

IDA 

#03 

•- 

663 

0205 

B7 

13 

STA 

PTR4 

-- 

664 

0207 

67 

1A 

STA 

HUNDEG 

--  DEGRES  -  360.00 

665 

0209 

A6 

3C 

LDA 

#60 

-- 

666 

0206 

67 

14 

STA 

PTR3 

-- 

667 

0200 

AE 

15 

LDX 

#PTR2 

-- 

668 

020F 

7F 

CLREM 

CLR 

,x 

-- 

669 

0210 

5C 

INCX 

-•  EVERYTHING  ELSE  IS  ZERO  BEFORE  CHANGE. 

670 

0211 

A3 

19 

CPX 

iCTPTRI 

•- 

671 

0213 

23 

FA 

8LS 

CLREM 

-* 

672 

*** 

673 

0215 

AD 

16 

C CUN EG 

BSR 

ADDBCD 

674 

0217 

CD 

02 

FD 

JSR 

DECPOS 

675 

021A 

20 

06 

BRA 

UPOUT 

676 

*♦* 

677 

021C 

CD 

02 

CA 

CCWPOS 

JSR 

SUB6CD 

678 

021 F 

CD 

02 

FO 

JSR 

DECPOS 

679 

*** 

680 

*** 

681 

** 

682 

683 

** 

684 

**  OUTPUT  ROUTINE.  ROUTINE  TO  PRINT  DATA  TO  THE  OUTPUT  PORTS.  BY 

685 

** 

CALLING  THE  APPROPRIATE  SUBROUT I NE.(' OUT CT'  TO  OUTPUT  THE 

686 

*• 

THE 

COUNT  AND  1 

'OUTPOS'  TO  OUTPUT  THE  POSITION). 

687 

** 

688 

0222 

UPOUT 

EOU 

S 

689 

** 

690 

0222 

09 

25 

04 

BRCLR 

POSCT.STAT.PUTCT 

691 

** 

692 

0225 

CO 

03 

68 

JSR 

OUTPOS 

693 

0228 

80 

RTI 

694 

** 

695 

0229 

CO 

03 

4E 

PUTCT 

JSR 

OUTCT 

696 

022C 

80 

RTI 

697 

** 

698 

************************************************************************ 

699 

*********** 

SUBROUTINE 

TO  INCREMENT  THE  BCD  COUNTER  (BCDCT).  ********* 

700 

**• 

701 

0220 

B6 

19 

ADDBCD 

LDA 

CTPTR1 

702 

022  F 

AB 

01 

ADD 

#1 

703 

0231 

A1 

63 

CMP 

#99 

CTPTR  >  99  ? 

704 

0233 

23 

05 

BLS 

OKI 

NO,  WE'RE  OK  HERE.  LOOK  UP  THE  FIRST  TWO  DIGITS. 

705 

0235 

AO 

64 

SUB 

#100 

YES...  MODIFY  THE  CTPTR, 

706 

0237 

99 

SEC 

SET  THE  CARRY,  AND 

707 

0238 

20 

01 

BRA 

OKU 

USE  TABLE  LOOK  UP. 

708 

•  ** 

709 

023A 

98 

OKI 

CLC 

NO  CARRY  EXISTS  IF  WE  ENTER  AT  THIS  POINT 

710 

0236 

B7 

19 

0K1A 

STA 

CTPTR1 

-- 

711 

0230 

97 

TAX 

-- 

712 

*** 

—  LOOK  UP  THE  TWO  LEAST  SIGNIFICANT  DIGITS. 

713 

023E 

06 

03 

BE 

LDA 

TABLE, X 

-- 

714 

0241 

B7 

20 

STA 

TENONE 

-- 

715 

0243 

24 

24 

BCC 

NOMO 

AND  CONTINUE  ONLY  IF  THERE  WAS  A  CARRY. 

716 

*** 

717 

••* 

718 

0245 

66 

18 

LDA 

CTPTR2 

719 

0247 

A9 

00 

ADC 

#0 

ADD  THE  CARRY. 

720 

0249 

A1 

63 

CMP 

#99 

CTPTR  >  99  7 

721 

024B 

23 

05 

BLS 

0K2 

NO,  WE'RE  OK  HERE.  LOOK  UP  THE  NEXT  TWO  DIGITS. 
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722 

0240 

*0 

64 

SUB 

#100  YES...  MODIFY  THE  CTPTR, 

723 

024F 

99 

SEC 

SET  THE  CARRY,  AND 

724 

0250 

20 

01 

BRA 

0K2A  USE  TABLE  LOOK  UP. 

725 

*** 

726 

0252 

98 

0K2 

CLC 

NO  CARRY  EXISTS  IF  UE  ENTER  AT  THIS  POIHT 

727 

0253 

87 

18 

0K2A 

STA 

CTPTR2  -- 

728 

0255 

97 

TAX 

-- 

729 

*** 

--  LOOK  UP  THE  NEXT  TWO  DIGITS  IN  THE  TABLE. 

730 

0256 

06 

03  BE 

LDA 

TABLE.X  -- 

731 

0259 

87 

IF 

STA 

HUNDRD  -* 

732 

025B 

24 

OC 

BCC 

HOMO  AHD  CONTINUE  ONLY  IF  THERE  WAS  A  CARRY. 

733 

*** 

734 

0250 

86 

17 

LDA 

CTPTR3 

735 

025F 

A9 

00 

ADC 

#0  ADO  THE  CARRY. 

736 

0261 

87 

17 

STA 

CTPTR3  -- 

737 

0263 

97 

TAX 

-- 

738 

*** 

-  LOOK  UP  THE  NEXT  TWO  DIGITS  IN  THE  TABLE 

739 

0264 

06 

03  BE 

LDA 

TABLE.X  -• 

740 

0267 

87 

IE 

STA 

TENTHO  -- 

741 

*** 

742 

0269 

81 

MONO 

RTS 

743 

*** 

744 

1  ft*  ********  *******  A  A  A*  4**41  A  A  *****************  ********* 

745 

'**  SUBROUTINE  TO  INCREMENT  THE  POSITION  COUNTER  (DEGRES).  ******* 

746 

*** 

747 

**** 

FIRST  CHECK  TO  SEE  IF  THE  BINARY  COUNTER  HAS  REACHED  A  MODULO  32 

748 

***** 

NUMBER 

749 

**** 

750 

026A 

00 

25  04 

INCPOS  BRCLR 

MOO  32,STAT, INC7  'MOD  32.STAT'  SET  ? 

751 

**** 

752 

0260 

*6 

08 

LDA 

#8  YES  . . . 

753 

026F 

20 

02 

BRA 

INC  INCREMENT  THE  POSITION  BY  0.008  DEGREES. 

754 

**** 

755 

0271 

*6 

07 

INC7 

LDA 

#7  NO  .... 

756 

0273 

B7 

22 

INC 

STA 

POSINC  INCREMENT  THE  POSITION  BY  0.007  DEGREES. 

757 

•*** 

758 

**** 

ROUTINE  TO 

INCREMENT  THE  POSITION  COUNTER  .'DEGREES'  BY  A 

759 

**** 

PREDETERMINED  AMOUNT.  'POSINC'. 

760 

**** 

761 

0275 

B6 

16 

LDA 

PTR1 

762 

0277 

88 

22 

ADD 

POSINC 

763 

0279 

*1 

09 

CMP 

#9  PTR1  >  9  7 

764 

027B 

23 

05 

BLS 

0K3  NO,  WE'RE  OK  HERE.  LOOK  UP  THE  FIRST  DIGIT. 

765 

0270 

*0 

OA 

SUB 

#10  YES...  MOOIFY  THE  CTPTR, 

766 

027F 

99 

SEC 

SET  THE  CARRY,  AND 

767 

0280 

20 

01 

BRA 

0K3A  USE  TABLE  LOOK  UP. 

768 

**** 

769 

0282 

98 

0*3 

CLC 

NO  CARRY  EXISTS  IF  WE  ENTER  AT  THIS  POINT 

770 

0283 

B7 

16 

0K3A 

STA 

PTR1 

771 

0285 

97 

TAX 

-- 

772 

••** 

--  LOOK  UP  THE  LEAST  SIGNIFICANT  DIGIT. 

773 

0286 

06 

03  BE 

LDA 

TABLE.X  -- 

774 

0289 

B7 

10 

STA 

THOUTH  -- 

775 

0288 

24 

3C 

BCC 

DONE  ANO  CONTINUE  ONLY  IF  THERE  WAS  A  CARRY. 

776 

**** 

777 

**** 

778 

0280 

86 

15 

LDA 

PTR2 

779 

028F 

*9 

00 

ADC 

#0  ADD  THE  CARRY. 

780 

0291 

*1 

63 

CMP 

#99  PTR2  >  99  7 

781 

0293 

23 

05 

BLS 

0K4  NO,  WE'RE  OK  HERE.  LOOK  UP  THE  NEXT  TWO  DIGITS. 

782 

0295 

AO 

64 

SUB 

#100  YES... MOOIFY  THE  CTPTR, 

783 

0297 

99 

SEC 

SET  THE  CARRY, 

784 

0298 

20 

01 

BRA 

0K4A  ANO  USE  TABLE  LOOK  UP. 

785 

**** 

786 

029* 

98 

0K4 

CLC 

NO  CARRY  EXISTS  IF  WE  ENTER  AT  THIS  POINT 

787 

0298 

87 

15 

0K4A 

STA 

PTR2 

99 


786 

0290 

97 

TAX 

•• 

789 

#*** 

••  LOOK  UP  THE  NEXT  TWO  DIGITS  IN  THE  TABLE 

790 

029E 

06  03  BE 

U)A 

TABLE, X  - 

791 

02A1 

87  1C 

STA 

NUNDTH  -- 

792 

02A3 

24  24 

BCC 

DONE  AND  CONTINUE  ONLY  IF  THERE  UAS  A  CARRY. 

793 

**** 

794 

**** 

795 

02A5 

86  14 

UDA 

PTR3 

796 

02A7 

A9  00 

ADC 

#0  ADO  THE  CARRY. 

797 

02A9 

A1  63 

CMP 

#99  PTR3  >  99  7 

798 

02AB 

23  05 

BLS 

0K5  NO,  UE'RE  OK  IK  RE.  LOOK  UP  THE  NEXT  TUO  DIGITS. 

799 

02AD 

AO  64 

SUB 

#100  YES...  MODIFY  THE  CTPTR, 

800 

02AF 

99 

SEC 

SET  THE  CARRY,  AND 

801 

0280 

20  01 

BRA 

0K5A  USE  TABLE  LOOK  UP. 

802 

#*** 

803 

0282 

98 

OKS 

CLC 

NO  CARRY  EXISTS  IF  UE  ENTER  AT  THIS  POINT 

804 

0283 

87  14 

0K5A 

STA 

PTR3 

805 

02B5 

97 

TAX 

-- 

806 

**** 

—  LOOK  UP  THE  NEXT  TUO  DIGITS  IN  THE  TABLE. 

807 

0286 

D6  03  BE 

IDA 

TABLE, X  — 

808 

0289 

87  IB 

STA 

ONEDEG  •• 

809 

02BB 

24  OC 

BCC 

DONE  AND  CONTINUE  ONLY  IF  THERE  UAS  A  CARRY. 

810 

**** 

811 

02BD 

B6  13 

IDA 

PTR4 

812 

02BF 

A9  00 

ADC 

#0  ADD  THE  CARRY. 

813 

02C1 

B7  13 

STA 

PTR4 

814 

02C3 

97 

TAX 

-- 

815 

***# 

--  LOOK  UP  THE  NEXT  TUO  DIGITS  IN  THE  TABLE 

816 

02C4 

06  03  BE 

LDA 

TABLE, X  -- 

817 

02C7 

B7  1A 

STA 

HUNDEG  - 

818 

#*++ 

819 

02C9 

81 

DONE 

RTS 

820 

•** 

821 

** 

822 

823 

*  SUBROUTINE  TO  DECREMENT  THE  BCD  COUNTER  (BCDCT) .  **»**•*•••** 

824 

*## 

825 

02CA 

B6  19 

SU8BC0 

LDA 

CTPTR 1 

826 

02CC 

AO  01 

SUB 

#1  CTPTR  >  99  ? 

827 

02CE 

24  03 

BCC 

0K6  NO,  UE'RE  OK  HERE.  LOOK  UP  THE  FIRST  TUO  DIGITS. 

828 

0200 

AB  64 

ADD 

#100  YES,  MODIFY  THE  CTPTR.  AND 

829 

0202 

99 

SEC 

GENERATE  A  BORROW. 

830 

831 

0203 

B7  19 

0K6 

STA 

CTPTR1  -- 

832 

0205 

97 

TAX 

-- 

833 

*** 

••  LOOK  UP  THE  TUO  LEAST  SIGNIFICANT  DIGITS. 

834 

0206 

06  03  BE 

LOA 

TABLE, X  -- 

835 

0209 

B7  20 

STA 

TENONE  -- 

836 

02DB 

24  IF 

BCC 

COMPLT  AND  CONTINUE  ONLY  IF  THERE  UAS  A  BORROW. 

837 

*** 

838 

♦  ** 

839 

0200 

B6  18 

LDA 

CTPTR2 

840 

02DF 

A2  00 

SBC 

#0  SUBTRACT  THE  CARRY.  CTPTR  >  99  ? 

841 

02E1 

24  03 

BCC 

0K7  NO,  UE'RE  OK  HERE.  LOOK  UP  THE  NEXT  TUO  DIGITS. 

842 

02E3 

AB  64 

ADO 

#100  YES,  MODIFY  THE  CTPTR,  AND 

843 

02E5 

99 

SEC 

GENERATE  A  BORROW. 

844 

*** 

845 

02E6 

87  18 

0K7 

STA 

CTPTR2  -• 

846 

02E8 

97 

TAX 

-- 

847 

*** 

--  LOOK  UP  THE  NEXT  TUO  DIGITS  IN  THE  TABLE 

848 

02E9 

06  03  BE 

LDA 

TABLE, X  ** 

849 

02EC 

87  IF 

STA 

HUNORD  -• 

850 

02EE 

24  OC 

BCC 

COMPLT  AND  CONTINUE  ONLY  IF  THERE  UAS  A  CARRY. 

851 

*** 

852 

02FO 

86  17 

LDA 

CTPTR3 

853 

02F2 

A2  00 

SBC 

#0  SUBTRACT  THE  BORROU. 

100 


854 

02F4 

87  17 

STA 

CTPTR3 

-- 

855 

0276 

97 

TAX 

“  ” 

856 

#«* 

—  LOOK  UP  THE  NEXT  TWO  DIGITS  IN  THE  TABLE 

857 

02F7 

06  03  BE 

LDA 

TABLE, X 

-- 

858 

02FA 

B7  IE 

STA 

TENTHO 

-• 

8S9 

*** 

860 

02FC 

81 

COHPLT 

RTS 

861 

*♦* 

******** 

********* 

862 

863 

SUBROUTINE  TO  DECREMENT  THE  POSITION  COUNTER  (DEGRES).  ******* 

864 

*** 

865 

**“  FIRST  CHECK  TO  SEE  IF  THE  BINARY  COUNTER  HAS  REACHED  A  MODULO  32 

866 

NUMBER 

867 

*♦** 

868 

02  FD 

00  25  04 

DECPOS 

BRCLR 

MOO  32,STAT,DEC7  'MOO  32.STAT'  SET  7 

869 

**** 

870 

0300 

A6  08 

LDA 

86 

YES... 

871 

0302 

20  02 

BRA 

DEC 

DECREMENT  THE  POSITION  BY  0.008  DEGREES. 

872 

**** 

873 

0304 

A6  07 

0EC7 

LDA 

#7 

HO  .... 

874 

0306 

B7  22 

DEC 

STA 

POSINC 

DECREMENT  THE  POSITION  BY  0.007  DEGREES. 

875 

*#** 

876 

****  ROUTINE  TO  DECREMENT  THE  POSITION  COUNTER  'DEGREES', BY  A 

877 

**•* 

PREDETERMINED  AMOUNT,  'P0S1NC'. 

878 

**** 

879 

0308 

B6  16 

LOA 

PTR1 

880 

030A 

BO  22 

SUB 

POSINC 

PTR1  <  0  7 

881 

030C 

24  03 

BCC 

0K8 

NO,  UE'RE  OK  HERE.  LOOK  UP  THE  FIRST  DIGIT. 

882 

030E 

AB  OA 

ADD 

#10 

YES,  MODIFY  THE  CTPTR,  AND 

883 

0310 

99 

SEC 

GENERATE  A  BORROW. 

884 

**** 

885 

0311 

B7  16 

OKB 

STA 

PTR1 

-- 

886 

0313 

97 

TAX 

.. 

887 

•*** 

--  LOOK  UP  THE  LEAST  SIGNIFICANT  DIGIT. 

888 

0314 

06  03  BE 

LDA 

TABLE, X 

889 

0317 

B7  10 

STA 

THOUTH 

890 

0319 

24  32 

BCC 

DUN SUB 

AMD  CONTINUE  ONLY  IF  THERE  WAS  A  BORROW. 

891 

*** 

892 

*** 

893 

031B 

B6  15 

LDA 

PTR2 

894 

0310 

A2  00 

SBC 

#0 

SUBTRACT  THE  BORROW.  PTR2  <07 

895 

031 F 

24  03 

BCC 

0K9 

NO,  UE'RE  OK  HERE.  LOOK  UP  THE  NEXT  TWO  DIGITS. 

896 

0321 

AB  64 

ADD 

#100 

YES,  MODIFY  THE  CTPTR,  AND 

897 

0323 

99 

SEC 

GENERATE  A  BORROW. 

898 

*•* 

899 

0324 

B7  15 

0K9 

STA 

PTR2 

-- 

900 

0326 

97 

TAX 

-- 

901 

*** 

--  LOOK  UP  THE  NEXT  TWO  DIGITS  IN  THE  TABLE. 

902 

0327 

D6  03  BE 

LOA 

TABLE, X 

-- 

903 

032A 

B7  1C 

STA 

HUNDTH 

904 

032C 

24  IF 

BCC 

DUN  SUB 

AND  CONTINUE  ONLY  IF  THERE  WAS  A  CARRY. 

905 

•** 

906 

*** 

907 

032E 

B6  14 

LDA 

PTR3 

908 

0330 

A2  00 

SBC 

#0 

SUBTRACT  THE  BORROW.  PTR3  <07 

909 

0332 

24  03 

BCC 

OK  10 

NO,  UE'RE  OK  HERE.  LOOK  UP  THE  NEXT  TUO  DIGITS. 

910 

0334 

AB  64 

ADD 

#100 

YES,  MODIFY  THE  CTPTR,  AND 

911 

0336 

99 

SEC 

GENERATE  A  BORROW. 

912 

•*** 

913 

0337 

B7  14 

OK  10 

STA 

PTR3 

.. 

914 

0339 

97 

TAX 

-- 

915 

•*** 

-•  LOOK  UP  THE  NEXT  TUO  DIGITS  IN  THE  TABLE 

916 

033A 

06  03  BE 

LDA 

TABLE, X 

-- 

917 

0330 

87  IB 

STA 

ONEDEG 

-- 

918 

033F 

24  OC 

BCC 

DUN  SUB 

AND  CONTINUE  ONLY  IF  THERE  UAS  A  CARRY. 

919 

**** 

920 

0341 

86  13 

LDA 

PTR4 

921 

0343 

A2  00 

SBC 

NO  SUBTRACT  THE  BORROU. 

922 

0345 

87  13 

STA 

PTR4 

923 

0347 

97 

TAX 

-- 

924 

ft*** 

-•  LOOK  UP  THE  NEXT  TWO  DIGITS  IN  THE  TABLE. 

925 

0348 

06  03  BE 

LDA 

TABLE.X  -- 

926 

0348 

87  1A 

STA 

HUNDEG  - 

927 

ft*** 

928 

0340 

81 

DUNSUB 

RTS 

929 

*** 

930 

** 

931 

** 

932 

******* 

933 

** 

934 

**  OUTPUT  COUNT  (OUTCT).  SUBROUTINE  TO  HOVE  THE  CURRENT  COUNT  (BCOCT) 

93S 

ft* 

TO  THE  OUTPUT  PORTS. 

REMOVES  THE  DECIMAL  POINT  FROM  THE 

936 

ft* 

DISPLAY  AND  BLANKS  ALL  BUT  THE  LEAST  SIGNIFICANT  DIGIT.  ALSO 

937 

ft* 

SETS  THE  MI HUS  SIGN 

IF  APPROPRIATE. 

938 

ft* 

939 

034E 

OUTCT 

EQU 

8 

940 

** 

941 

034E 

86  20 

LDA 

TEHONE 

942 

0350 

87  02 

STA 

PORTC 

943 

** 

944 

0352 

B6  IF 

LDA 

HUNDRD 

945 

0354 

87  00 

STA 

PORTA 

946 

** 

947 

0356 

86  IE 

LDA 

TENTHO 

948 

0358 

B7  01 

STA 

PORTB 

949 

•* 

950 

035A 

IE  01 

BSET 

DECPT, PORTB 

951 

035C 

19  01 

BCLR 

BLANK .PORTS 

952 

** 

953 

035E 

04  25  04 

BRSET 

NEGTIV.STAT, MINUS 

954 

0361 

1C  01 

BSET 

POST IV, PORTB 

955 

0363 

20  02 

BRA 

ALLDUN 

956 

** 

957 

0365 

ID  01 

MINUS 

BCLR 

POSTIV, PORTB 

958 

** 

959 

0367 

81 

ALLDUN 

RTS 

960 

** 

961 

** 

962 

**  OUTPUT  POSITION  (OUTPOS). 

SUBROUTINE  TO  MOVE  THE  CURRENT  POSITION 

963 

ft* 

COUNT 

(BCOCT)  TO  THE 

OUTPUT  PORTS.  THE  DECIMAL  POINT  IS 

964 

•  ft 

DISPLAYED  ,  AND  ONLY 

THE  MOST  SIGNIFICANT  DIGIT  IS  BLANKED. 

965 

ft* 

966 

0368 

OUTPOS 

ECU 

S 

967 

** 

968 

0368 

86  ID 

LDA 

THOUTH  -- 

969 

036A 

A1  05 

CMP 

• 5 

970 

036C 

25  38 

BLO 

TRUNC 

IF  5  >  ‘THOUTH'  SIMPLY  TRUNCATE  THE 

971 

036E 

B6  1C 

LDA 

HUNDTH 

••  DISPLAY.  OTHERWISE... 

972 

0370 

A4  09 

AND 

09 

--  IF  THE  LAST  DIGIT  ISN'T  A  NINE  IT  IS 

973 

0372 

A1  09 

CMP 

09 

-  EASY  TO  ROUND  UP.  JUST  ADO  A  ONE. 

974 

0374 

26  28 

8NE 

DECIMAL 

-- 

975 

0376 

86  1C 

LDA 

HUNDTH 

--  BUT  IF  THE  LAST  DIGIT  IS  A  NINE  CHECK  TO 

976 

0378 

A1  99 

CMP 

•S99 

--  SEE  IF  IT'S  99.  IF  SO  IT  GETS  GRIN. 

977 

037A 

27  04 

BEG 

UGLY 

-- 

978 

037C 

AS  07 

ADO 

#7 

••  IF  THE  NUMBER  IS  X9  ANO  X  .HE.  9,  THEN 

979 

037E 

20  28 

BRA 

PCOUT 

••  JUST  ADD  SEVEN  TO  ROUNO  UP.  DUE  TO 

980 

** 

•-  HEX1DECIMAL. 

981 

** 

--  IF  THE  LOU  TWO  DIGITS  ARE  BOTH  NINES 

982 

0380 

A6  00 

UGLY 

LDA 

•00 

ANO  WE  NEED  TO  ROUND  UP _ 

983 

0382 

87  02 

STA 

PORTC 

MAKE  THE  LOW  TWO  DIGITS  BOTH  ZEROS 

984 

0384 

99 

SEC 

-- 

ANO  SET  THE  CARRY. 

985 

** 

102 


986 

0385 

86 

IB 

LDA 

ONEDEG  --  CHECK  THE  LAST  DIGIT  AS  BEFOKE. 

987 

0387 

A4 

09 

AND 

#9  IF  USING  THIS  PONT I OH  OF  THE  CODE 

968 

0389 

A1 

09 

CMP 

89  --  THERE  HAD  TO  BE  A  CARRY. 

969 

038B 

26 

IE 

BNE 

NEXT  --  IF  THE  LAST  DIGIT  IS  NOT  A  NINE  USE  THE 

990 

0380 

86 

18 

LDA 

ONEDEG  -  ADC  INSTRUCTION  BELOW. 

991 

038F 

A1 

99 

CMP 

8899  ••  IF  IT  IS  A  NINE,  IS  THE  NEXT  ONE  A  NINE 

992 

0391 

27 

04 

BEQ 

RLUGLY  --  ALSO? 

993 

0393 

AS 

07 

ADD 

87  IF  NOT  JUST  ADD  SEVEN, 

994 

0395 

20 

18 

BXA 

PAOUT  AND  DISPLAY  THE  OUTPUT. 

995 

** 

996 

0397 

A6 

00 

RLUGLY 

LDA 

800 

997 

0399 

87 

00 

STA 

PORTA  IF  SO  ROUND  UP  THE  MOST  SIGNIFICANT 

998 

0398 

99 

8EC 

DIGIT  AND  SET  EVERYTHING  ELSE  TO  ZERO. 

999 

039C 

20 

13 

BXA 

NEXT1 

1000 

#* 

1001 

039E 

86 

1C 

DEC I HAL 

LDA 

HUNDTH  -- 

1002 

03A0 

A8 

01 

ADD 

81 

1003 

** 

-•  THIS  IS  ALL  THAT  HEEDS  TO  BE  DONE  IF 

1004 

03A2 

87 

02 

STA 

PORTC  --  THE  LAST  DIGIT  IS  HOT  A  NINE. 

1005 

03A4 

20 

05 

BXA 

NEXT 

1006 

#* 

1007 

03A6 

86 

1C 

TRUNC 

LDA 

HUNDTH  — 

1008 

03A8 

87 

02 

PCOUT 

STA 

PORTC  --  AND  IF  THERE  IS  NO  CARRY  IT'S  EVEN  EASIER. 

1009 

03AA 

98 

CLC 

1010 

#* 

1011 

03AB 

B6 

18 

NEXT 

LDA 

ONEDEG 

1012 

03AD 

A9 

00 

ADC 

80 

1013 

03  A  F 

B7 

00 

PAOUT 

STA 

PORTA 

1014 

** 

1015 

0381 

B6 

1A 

NEXT1 

LDA 

HUNDEG 

1016 

0383 

A9 

00 

ADC 

80 

1017 

03B5 

87 

01 

STA 

PORTB 

1018 

** 

1019 

0387 

1C 

01 

BSET 

POSTIV.PORTB 

1020 

03B9 

18 

01 

BSET 

BLANK, PORTB 

1021 

0388 

IF 

01 

BCLX 

DECPT, PORTB 

1022 

** 

1023 

0380 

81 

RTS 

1024 

+* 

1025 

** 

1026 

********************************************************** 

1027 

** 

1028 

**  SET 

UP  THE 

TABLE  TO  BE  USED  WITH  BCD  INCREHENT/DECREMENT  ROUTINES. 

1029 

** 

1030 

* 

ENDS 

1031 

• 

DATA 

1032 

03BE 

00 

01  02  03  04 

TABLE 

FC8 

SOO, SOI, 802, $03, 804,805,806, 807,808, $09 

03C3 

05 

06  07  08  09 

1033 

03C8 

10 

11  12  13  14 

FCB 

810,811, 812,813, $14,815,816, 817,818,819 

03C0 

15 

16  17  18  19 

1034 

0302 

20 

21  22  23  24 

FCB 

820, S21 , 822, 823,824,825,826,827,828,829 

0307 

25 

26  27  28  29 

1035 

030C 

30 

31  32  33  34 

FCB 

830,831,832,833,834,835,836,837,838,839 

03E1 

35 

36  37  38  39 

1036 

03E6 

40 

41  42  43  44 

FCB 

840,841,842,843,844,845,846,847,848,849 

03EB 

45 

46  47  48  49 

1037 

03F0 

50 

51  52  53  54 

FCB 

850,851,852,853,854,855,856,857,858,859 

03F5 

55 

56  57  58  59 

1038 

03FA 

60 

61  62  63  64 

FCB 

860,861 ,862,863,864,865,866,867,868,869 

03FF 

65 

66  67  68  69 

1039 

0404 

70 

71  72  73  74 

FCB 

870,871,872,873,874,875,876,877,878,879 

0409 

75 

76  77  78  79 

1040 

040E 

80 

81  82  83  84 

FCS 

880,861,882,883,884,885,886,887,888,889 

0413 

85 

86  87  88  89 

1041 

0418 

90 

91  92  93  94 

FCB 

890,891,892,893,894,895,896,897,898,899 

0410 

95 

96  97  98  99 

103 


1042 

1043 

IIUI 

• 

• 

ENDS 

CODE 

HIM 

1045 

1046 

ft* 

SET  UP  MASK  OPTION  REGISTER. 

1047 

ft* 

1040 

0422 

ABSOLUTE 

1049 

ft* 

1050 

** 

1051 

0F38 

0BG 

NOR 

1052 

0F38 

07 

FC8 

MIT2+8IT1+SIT0 

1053 

** 

1054 

ft* 

COMMENTS: 

1055 

ft* 

BIT  7 

CLOCK  SOURCE  0  ■  CRYSTAL. 

1056 

ft* 

BIT  6 

TIMER  OPTION  0  ■  INTERNAL. 

1057 

ft* 

BIT  5 

TINER/CLOCK  SOURCE  0  •  INTERNAL. 

1058 

ft* 

BIT  4 

NOT  USED. 

1059 

ft* 

BIT  3 

MOT  USED. 

1060 

ft* 

BIT  2 

SET  - 

1061 

ft* 

BIT  1 

SET  -  PRESCALE  SELECT  111  »  128 

1062 

ftft 

BIT  0 

SET  • 

1063 

ft* 

1064 

ft* 

***** 

********* 

IWJ 

1066 

•* 

1067 

** 

ASSIGN  INTERRUPT  VECTORS. 

1068 

•* 

1069 

0FF8 

ORG 

INTRPT 

1070 

•• 

1071 

OFFS 

01 2E 

FOB 

BLINK  T1NER/INT2  INTERRUPT  VECTOR. 

1072 

OF  FA 

0140 

FOB 

COUNT  EXTERNAL  INTERRUPT  VECTOR. 

1073 

OFFC 

0140 

FOB 

COUNT  SOFTWARE  INTERRUPT  VECTOR,  NOT  USED. 

1074 

OFFE 

0080 

FOB 

RESTRT  RESET  VECTOR. 

1075 

ft* 

1076 

•* 

1077 

ft* 

1078 

ENDS 

1079 

1000 

END 

Line*  Assent) led  : 

1079 

ActMfely  Error*  :  0 
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C.  TILT 


1 

TTL 

POSITION  DETERMINING  PROGRAM  (ELEVATION) 

2 

* 

LATEST  REVISION  9  NAY  89 

3 

* 

FILE  NAME  TILT.ASM 

4 

** 

S 

**  PROGRAM  DESCRIPTION 

6 

*« 

7 

•• 

a 

•« 

9 

**  I/O  REGISTER  ADDRESSES 

10 

•• 

11 

0000 

PORTA 

EQU 

SOOOO 

I/O  PORT  A 

12 

0001 

PORTS 

ECU 

S0001 

I/O  PORT  B 

13 

0002 

PORTC 

EQU 

S0002 

I/O  PORT  C 

14 

0003 

PORTO 

EQU 

S0003 

INPUT  PORT  0 

15 

•• 

16 

**  DATA  DIRECTION  REGISTER  OFFSET 

17 

•* 

18 

0004 

DDR 

EQU 

4 

(eg.  DDR  FOR  PORT  A  IS  PORTA+ODR  ) 

10 

#♦ 

20 

**  OTHERS 

21 

•* 

22 

0008 

TIMER 

EQU 

10008 

EIGHT  BIT  TIMER  REGISTER. 

23 

0009 

TCR 

EQU 

10009 

TIMER  CONTROL  REGISTER. 

24 

OOOA 

MR 

EQU 

SOOOA 

MISCELLANEOUS  REGISTER. 

25 

0010 

RAM 

EQU 

10010 

START  OF  ON-CHIP  RAH(112  -  31  FOR  STACK) 

26 

0080 

2R0M 

EQU 

S0080 

PAGE  ZERO  OF  ROM. 

27 

0100 

ROM 

EQU 

10100 

START  OF  MAIN  RON. 

28 

0F38 

MOR 

EQU 

S0F38 

MASK  OPTION  REGISTER. 

29 

OFFS 

INTRPT 

EQU 

S0FF8 

LOCATION  OF  INTERRUPT  VECTORS. 

30 

1000 

MEMSIZ 

EQU 

11000 

MEMORY  ADDRESS  SIZE. 

31 

•• 

32 

**  EQUATES 

33 

•* 

34 

0001 

■ITO 

EQU 

1 

35 

0002 

SIT1 

EQU 

2 

36 

0004 

BIT2 

EQU 

4 

37 

0008 

BIT3 

EQU 

8 

38 

0010 

BIT4 

EQU 

16 

39 

0020 

BITS 

EQU 

32 

40 

0040 

BIT6 

EQU 

64 

41 

0080 

BIT7 

EQU 

128 

42 

#* 

43 

0000 

BO 

EQU 

0 

44 

0001 

B1 

EQU 

1 

45 

0002 

B2 

EQU 

2 

46 

0003 

S3 

EQU 

3 

47 

0004 

B4 

EQU 

4 

48 

0005 

BS 

EQU 

5 

49 

0006 

B6 

EQU 

6 

50 

0007 

B7 

EQU 

7 

51 

•• 

52 

•*  EQUATES  FOR 

THE  TIMER  CONTROL  REGISTER 

53 

•* 

54 

••• 

55 

0007 

TIR 

EQU 

7 

TIMER  INTERRUPT  REQUEST.  1  »  REQUEST,  0  «  NO  REQ 

56 

0006 

TIM 

EQU 

6 

TIMER  INTERRUPT  MASK.  1  ■  DISABLED,  0  ■  ENABLED. 

57 

0005 

TIN 

EQU 

5 

EXTERNAL  OR  INTERNAL  CLOCK  SOURCE.  1  ■.  EXT,  0  * 

58 

0004 

TEE 

EQU 

4 

EXTERNAL  CLOCK  ENABLE.  NOT  USED. 

59 

0003 

PSC 

EQU 

3 

PRESCALER  CLEAR.  NOT  USED. 

60 

0002 

PS2 

EQU 

2 

(PS2)  -- 

61 

0001 

PS1 

EQU 

1 

(PS1)  I-  PRESCALER  SELECT  BITS. 

105 


62 

63 

66 

65 

66 

67 

68 

69 

70 

71 

72 

73 
76 

75 

76 

77 

78 

79 

80 
81 
82 
83 
86 

85 

86 

87 

88 

89 

90 

91 

92 

93 
96 

95 

96 

97 

98 

99 
100 
101 
102 
103 
106 

105 

106 

107 

108 

109 

110 
111 
112 
113 
116 

115 

116 

117 

118 
119 


0000 


0007 

0006 

0005 

0006 

0003 

0002 


0007 

0006 

0006 


PSO  EQU  0  (PSO)  — 

** 

**  EQUATES  FOR  THE  STATUS  SYTE,  'STAT*. 


UD  EQU 
NOD  32  EQU 
FLASH  EQU 
POSCT  EQU 
L  SET  EQU 
NEGTIV  EQU 


COUNT  DIRECTION?  1  ■  UP,  0  ■  DOWN. 

IS  *IIHCT'  NODULO  32?  1  >  YES,  0  >  NO. 

SLINK  THE  DISPLAY?  1  >  YES,  0  ■  NO. 

DISPLAY  POSITION  OR  COUNT?  1  •  POS,  0  ■  COUNT. 
VALUE  OF  'NODE, PORTO'  LAST  TINE. 

IS  'BCDCT* NEGATIVE  NUMBER?  1  ■  YES,  0  •  NO. 

NOT  USED. 

NOT  USED. 


1/0  EQUATES  AND  DESCRIPTIONS. 

» 

» 

*  PORT  A  (I/O) 


1 

BCD  DIGIT  *6 

j 

BCD  DIGIT  S3 

] 

j 

06 

| 

C6  j 

B6  j 

A6 

i 

D3 

i 

C3  J 

B3 

i 

A3 

j 

BIT 

7 

6 

5 

6 

3 

2 

1 

0 

PORT  B  (I/O) 


-♦ - - ♦- 

DISPLAY  CONTROL 

-4 - 4.. ...... 4.. 


- - - 

MOT  USED 

-  -  -  - -4 - 


|  DECPT  |  POSTIV|  |  BLANK  |  |  | 

. . 4 . 4 . 4 - 4 . 4 . 4 . 

7  6  5  6  3  2  1 


DECPT 

POSTIV 


TO  DISPLAY  THE  DECIMAL  POINT... DECPT  IS  CLEARED 
USED  TO  DISPLAY  NEGATIVE  SIGN. . .CLEARED  TO  SHOW 
MINUS  SIGN. 

TO  BLANK  DIGITS  2  AND  3... CLEAR  BLANK. 

DIGITS  6  AND  5  ARE  ALWAYS  BLANKED. 

DIGIT  1  IS  NEVER  BLANKED. 


PORT  C  (I/O) 

4 - - 4 - 


4 - - 4 - 4 - ...-4 . 4 - - 4 . 4 . 4 

|  BCD  DIGIT  #2  | BCD  DIGIT  #1( LEAST  SIGNIFICANT)! 

4 - 4 - 4 - -4- - - - -4 - - 4 . 4- - - 4 - 4 

|  D2  |  C2  |  B2  |  A2  |  D1  |  Cl  |  B1  |  A1  | 

4 - 4 - - .-4-- . 4 - - 4 - - -4 - 4 - -  4 

7  6  5  6  3  2  1  0 


***  PORT  0  (INPUT  ONLY) 

**• 

***  4 . 4 . 4 . 4- 


120  ***  |  CH_A  |  IHT2  |  CH_B  |  FUNCT  |  SET  |  | 


121 

*** 

♦  ••• 

>♦ . ♦ . . 

. ♦ 

122 

•••  BIT 

7 

6  5  6 

3 

2  1 

0 

123 

*** 

126 

0007 

CH  A 

EQU 

7 

INDICATES  THE 

STATUS  OF 

CHANNEL  A. 

125 

0006 

I  NT  2 

EQU 

6 

INTERRUPT  #2. 

USED  TO  CHANGE  DISPLAY  MODES. 

126 

0005 

CH  B 

EQU 

5 

INDICATES  THE 

STATUS  OF 

CHANNEL  B. 

127 

0006 

FUNCT 

EQU 

6 

USED  TO  PUT  THE  PROGRAM 

IN  A  MODE  THAT 

WILL  ALLOW 

106 


128 

*•* 

*HYST'  TO  BE  INCREMENTED. 

129 

0003 

SET 

EQU  3 

INCREMENTS  'HYST'  MIEN  TOGGLED  AND  FUNCT  IS  LOU. 

ISO 

*** 

131 

*** 

132 

133 

** 

* 

134 

** 

RAM  VARIABLES  * 

13S 

** 

* 

136 

******** 

137 

** 

138 

«  RESERVE  MEMORY  SPACE 

FOR  THE  PROGRAM  VARIABLES. 

139 

+* 

140 

0000 

DATA 

141 

142 

** 

143 

0000 

ABSOLUTE  (ABSOLUTE  ADORESSING  USED  HERE  TO  RELATIVE  DIRECTIVE) 

144 

** 

145 

0010 

ORG  RAM 

START  OF  RAM. 

146 

++ 

147 

***  BINARY  COUNT. 

148 

0010 

BINCT 

RMB  2 

149 

0010 

HIBIN 

EQU  BINCT 

HI  BYTE. 

150 

0011 

LOB  IN 

EOU  BINCT+1 

LO  BYTE. 

151 

** 

152 

***  POSITION  POINTERS. 

153 

0012 

PTR 

RMB  3 

EACH  BYTE  POINTS  TO  A  POSITION  IN  THE 

154 

** 

TABLE  THAT  CONTAINS  ONE  OR  TWO  DIGITS 

155 

** 

OF  THE  BCD  POSITION. 

156 

0012 

PTR3 

EOU  PTR 

MOST  SIGNIFICANT  DIGITS. 

157 

0013 

PTR2 

EOU  PTR+1 

158 

0014 

PTR1 

EOU  PTR*2 

LEAST  SIGNIFICANT  DIGIT. 

159 

** 

160 

***  COUNT  POINTERS. 

161 

0015 

CTPTR 

RMB  2 

EACH  BYTE  POINTS  TO  A  POSITION  IN  THE 

162 

*• 

TABLE  THAT  CONTAINS  TUO  OF  THE  DIGITS 

163 

** 

IN  THE  BCD  COUNT. 

164 

0015 

CTPTR2 

EQU  CTPTR 

MOST  SIGNIFICANT  DIGITS. 

165 

0016 

CTPTR1 

EOU  CTPTR* 1 

LEAST  SIGNIFICANT  DIGITS. 

166 

•* 

167 

***  BCD 

POSITION  IN  DEGREES. 

168 

0017 

OEGRES 

RMB  3 

169 

0017 

ONEDEG 

EOU  DEGRES 

CONTENTS  X  1.000 

170 

0018 

HUNOTH 

EOU  DEGRES* 1 

CONTENTS  X  0.010 

171 

0019 

THOUTH 

EOU  DEGRES*2  *  CONTENTS  X  0.001 

172 

*** 

173 

POSITION  IN  DEGREES 

174 

** 

175 

***  BCD 

COUNT. 

176 

001A 

BCOCT 

RMB  2 

177 

001A 

HUNDRO 

EQU  BCDCT 

CONTENTS  X  100 

178 

001 B 

TENONE 

EQU  BCDCT*1 

*  CONTENTS  X  1 

179 

*** 

180 

••• 

NUMBER  OF  PULSES  COUNTED 

181 

*** 

182 

***  HYSTERESIS  COUNTER. 

POINTS  TO  A  NUMBER  IN  THE  TABLE  THAT  IS  THE 

183 

#*# 

AMOUNT  OF  HYSTERESIS  PRESENT  IN  THE  SYSTEN.  INITIALIZED  TO  6. 

184 

001C 

HYSTPT 

RMB  1 

185 

•* 

186 

***  POSITION  INCREMENT. 

CONTAINS  A  NUMBER,  THAT  UHEN  MULTIPLIED  BY  0.001 

187 

*+* 

IS  THE  NUMBER  OF  DEGREES  THAT  THE  POSITION  COUNTER  (BCDPOS)  IS 

188 

*•* 

TO  BE  INCREMENTED  OR  DECREMENTED  DURING  PROGRAM  EXECUTION. 

189 

THE  VALUE  OF  'POSINC',  DETERMINED  EXPERIMENTALLY.  SHOULD  BE 

190 

*** 

7.0452.  SINCE 

THE  PROGRAM  IS  DESIGNED  WORK  WITH  INTEGERS  ONLY 

191 

THIS  NUMBER  IS  ROUNDED  TO  7.  TO  REDUCE  THE  CUMULATIVE  EFFECT  OF 

192 

#♦* 

THE  ROUND  OFF, 

EVERY  32  COUNTS  'POSINC'  IS  SET  EQUAL  TO  8.  THIS 

193 

•*# 

AGAIN  LEADS  TO 

SOME  CUMULATIVE  ERROR,  BUT  THE  SMALL  ANGULAR  RANGE 

107 


00 1 E 
001F 


0020 

0021 


194 

195 

197  001D 

196 

199 

200 
201 
202 

203 

204 

205 

206 
207 
206 

209 

210 
211 
212 

213 

214 

215 

216 

217 

218 

219 

220 
221 
222 

223 

224 

225 

226 

227 

228 

229 

230 

231 

232 


***  OF  THE  TILT  ANGLE  (10.5  DEGREES)  ALLOWS  US  TO  NEGLECT  ANY  FURTHER 
MODIFICATIONS. 

*** 

POSINC  RMS  1 
*** 

***  HYSTERESIS  VARIABLES.  USEO  TO  ELIMINATE  THE  EFFECTS  OF  BACKLASH  ON 
***  THE  POSITION  MEASUREMENTS. 


HYST  RMB  1 

•** 

HYSTCT  RMB  1 

*** 

***  STATUS  BYTE.  USED  TO  KEEP  TRACK  OF  WHAT  IS  GOING  ON. 


THE  THRESH HOLD  VALUE  DETERMINED 
EXPERIMENTALLY. 

CURRENT  AMOUNT  OF  HYSTERESIS  MEASURED. 


STAT 

LSTAT 


1  CURRENT  STATUS. 

1  PREVIOUS/LAST  STATUS.  USED  TO  KEEP  TRACK  OF 

L_SET  ONLY. 


•**  TIMER  COUNTER.  USED  IN  CONJUNCTION  WITH  THE  TIMER  PRESCALER  AND  THE 
***  TOR  TO  KEEP  TRACK  OF  ONE  SEC.  INTERVALS.  USED  IN  BLINKING  THE 
***  DISPLAY.  INITIALLY  SET  TO  31,  WHEN  THE  'FLASH'  BIT  OF  'STAT' 
***  IS  SET.  TIMCT  IS  DECREMENTED  EACN  CLOCK  INTERRUPT  (APPROX.  31 
***  TIMES  PER  SEC).  RESET  TO  31  WHEN  CONTENTS  GO  TO  ZERO. 

***  WHEN  (TIMCT)-O  THE  DISPLAY  WILL  TOGGLE. 


0022 


TIMCT 


RMB 

ENOS 


1 


************** 


PAGE  ZERO  ROM 


INITIALIZATION  ROUTINE. 


** 

•• 


233 

0000 

CODE 

234 

** 

235 

0080 

ORG 

ZRCM 

PAGE  ZERO  ROM. 

236 

*# 

237 

0080 

RELATIVE 

RELATIVE  ADDRESSING  MUST  BE  USED  FOR  THE 

238 

•  • 

239 

0080 

RESTRT 

EQU 

S 

THIS  IS  THE  ENTRY  POINT  WHEN  AN  EXTERNAL 

240 

*** 

INTTERRUPT  OCCURS. 

241 

** 

242 

243 

** 

244 

••• 

INITIALIZE  THE  PC  AND  CLEAR  RAM. 

245 

•** 

246 

•** 

247 

0080 

9B 

SEI 

SET  INTERUPT  TO  AVOID  INTERUPTION  AND 

248 

0081 

9C 

RSP 

RESET  THE  STACK  POINTER.  JUST  IN  CASE! 

249 

*•* 

250 

0082 

AE  10 

LDX 

BBINCT 

CLEAR  ALL  OF  TNE  VARIABLES  BETWEEN 

251 

0084 

7F 

CLRIT 

CLR 

.X 

'BINCT'  AND  'TIMCT'  (INCLUSIVE). NOTE 

252 

0085 

5C 

INCX 

THAT  THIS  SETS  THE  COUNTER  ANO  THE  POS- 

253 

0086 

A3  22 

CPX 

BTIMCT 

ITION  TO  ZERO.  THIS  MEANS  THAT  ROTATION 

254 

0088 

23  FA 

BLS 

CLRIT 

SHOULD  START  IN  AN  INCREASING  (CW) 

255 

*** 

DIRECTION  FROM  THE  MOST  CCW  POSITION 

256 

•** 

AFTER  A  RESET. 

257 

*** 

- 

258 

008A 

ABSOLUTE 

BACK  TO  ABSOLUTE  ADDRESSING. 

259 

*** 

108 


260 

261 

262 

263 

264 

265 

266 

267 

268 

269 

270 

271 

272 

273 

274 

275 

276 

277 

278 

279 

280 
281 


285 

286 

287 

288 

289 

290 

291 

292 

293 

294 

295 

296 

297 

298 

299 

300 

301 

302 

303 

304 

305 

306 

307 

308 

309 

310 

311 

312 

313 

314 

315 

316 

317 

318 

319 

320 

321 

322 

323 

324 

325 


00A0  A6  47 


00A2  B7  09 


00A4 

00A6 


00A8 

OOAA 


00  A  E 
0081 


A6  FF 
B7  08 


A6  IF 
B7  22 


OOAC  ID  OA 


CO  02  D8 
1C  01 


*** 

ESTABLISH  I/O  PORTS. 

*•* 

008A 

A6  FF 

LOA 

#-1 

PORTS  A,B,C  ARE  CONFIGURED  AS 

008C 

B7  04 

STA 

PORTA+OOR 

ALL  OUTPUT.  PORT  D  IS  ALL  INPUT 

008E 

B7  05 

STA 

PORTB+OOR 

SO  THERE  IS  NO  MASK  TO  SET. 

0090 

B7  06 

*** 

STA 

PORTC+OOR 

*** 

SET  UP  TNE  STATUS  REGISTER. 

»** 

0092 

A6  08 

LDA 

#K00001000 

-• 

0094 

B4  03 

AND 

PORTO 

|—  >  SET  UP  *L  SET'  BIT  OF  'STAT'. 

0096 

B7  20 

*♦* 

STA 

STAT 

•• 

0098 

1C  20 

** 

BSET 

M0D_32,STAT 

0  IS  MODULO  32. 

INITIALIZE  HYSTCT . 


282 

009A 

A6  06 

LDA 

#06 

283 

009C 

B7  IE 

STA 

HYST 

284 

009E 

B7  1C 

STA 

HYSTPT 

•• 

••• 


SET  UP  THE  TIMER  FOR  A  4  NH2  CRYSTAL  /  4  *  1  MHZ  CLOCK. 


***  NOTE:  THE  MASK  OPTION  REGISTER  IS  IN  ROM.  IT  IS  SET  UP  AT 

***  THE  END  OF  THE  PROGRAM. 

*** 

*********************  up  fug  TCR.  »**»»**»»**»«*»»*♦»»»««»»*»»*»»« 

••• 

LOA  #BIT6*B1T2+B1T1+BIT0 

***  (TIM)|(PS2)(PS1>(PS0) 

•••(DISABLE  INTERRUPT) j (PRESCALE  BY  128) 


STA 


TCR 


***  SET  UP  THE  TIMER. 

LOA  #255  1  MHZ/(128*255)  «  30.6  (APPROX.  31) 

STA  TIMER 


INITIALIZE  THE  TIMER  COUNTER. 


LDA  #31  PROVIDES  FOR  1  SEC.  BLINK  INTERVAL. 

STA  TIMCT  FOR  2  SEC.  INTERVAL  JUST  USE  TIMECT-62,  etc. 


SET  UP  MISCELLANEOUS  REGISTER. 
BCLR  B6,NR  ENABLES  THE  SECOND  INTERRUPT. 


COUNT  *  0  IS  DISPLAYED  INITIALLY. 

JSR  OUTCT 

BSET  POST! V.PORTB 


109 


326 

327 
326 

329 

330 

331 

0083 

0084 

9A 

** 

*** 

*** 

CL I  CLEAR  THE  INTERRUPT  MASK  TO  GET  STARTED. 

RELATIVE  RELATIVE  ADDRESSING  MUST  BE  USED  FOR  THE 

REMAINDER  OF  THE  PROGRAM. 

332 

******** 

333 

** 

334 

**  WAIT 

LOOP. 

EXECUTES,  UNTIL  AN 

INTERRUPT  OCCURS. 

335 

** 

336 

0084 

09  03  08 

PAUSE 

BRCLR 

FUNCT, PORTO, CHHYST  WANT  TO  CHANGE  HYST7 

337 

•* 

YES... 00  TO  CHHYST. 

338 

0087 

06  03  04 

BRSET 

SET, PORTO, Si IT 

NO... 'SET, PORTO'  SET? 

339 

OOBA 

17  20 

BCLR 

L  SET, ST AT 

NO... CLEAR  'L  SET.STAT' 

340 

OOSC 

20  F6 

BRA 

PAUSE 

AND  LOOP. 

341 

OOBE 

16  20 

S8IT 

8SET 

L  SET.STAT 

YES... SET  ‘L  SET.STAT' 

342 

OOCO 

20  F2 

BRA 

PAUSE 

AND  LOOP. 

343 

** 

344 

******** 

345 

#+ 

346 

**  HYSTERESIS  MODIFICATION  ROUTINE 

.  PERMITS  MODIFICATION  OF  THE 

347 

**  HYSTERESIS  BUFFER  WITHOUT  REPROGRAMMING. 

348 

#• 

YES... 

349 

00C2 

A6  40 

CHHYST 

LOA 

8BIT6 

DISABLE  TIMER  INTERRUPT. 

350 

00C4 

B7  09 

STA 

TCR 

351 

*** 

352 

0006 

A6  08 

LOA 

RX00001000 

SAVE  'L  SET' 

353 

OOC8 

B4  20 

AND 

STAY 

INTO 

354 

OOCA 

B7  21 

STA 

LSTAT 

‘LSTAT'. 

355 

OOCC 

A6  08 

LOA 

nooooiooo 

356 

OOCE 

B4  03 

AND 

PORTO 

'SET.PORTD'  ACCUMULATOR 

357 

OOOO 

B1  21 

CMP 

LSTAT 

HAS  THE  SET  SWITCH  BEEN  CHANGED? 

358 

0002 

27  15 

BEO 

OISPLA 

359 

*** 

YES... 

360 

0004 

A6  08 

LOA 

nooooiooo 

-- 

361 

0006 

B8  20 

EOR 

STAT 

|-->CHANGE  ‘L  SET.STAT', 

362 

0008 

B7  20 

STA 

STAT 

-- 

363 

OOOA 

3C  IE 

INC 

HYST 

THEN  INCREMENT  THE  HYSTERESIS 

364 

OOOC 

3C  1C 

INC 

HYSTPT 

POINTER  AND  ‘HYST'.., 

365 

*** 

366 

000 E 

B6  1C 

LOA 

HYSTPT 

-- 

367 

OOEO 

A1  19 

CMP 

#25 

-- 

368 

00E2 

23  05 

BLS 

OISPLA 

-* 

369 

*** 

-*  BUT  NOT  ABOVE  25. 

370 

00E4 

4F 

CLRA 

THEN---> 

371 

00E5 

B7  IE 

STA 

HYST 

-- 

372 

00E7 

B7  1C 

STA 

HYSTPT 

-- 

373 

*•* 

374 

00E9 

A6  00 

OISPLA 

LOA 

RXOOOOOOOO 

NO...  JUST . > 

375 

OOEB 

B7  00 

STA 

PORTA 

-- 

376 

OOEO 

A6  CO 

LOA 

m ioooooo 

377 

OOEF 

B7  01 

STA 

PORTS 

\ 

/ 

378 

*** 

--  DISPLAY  CURRENT  ‘HYST* . 

379 

00F1 

BE  1C 

LDX 

HYSTPT 

380 

00F3 

D6  03  28 

LOA 

TABLE, X 

-- 

381 

00F6 

B7  02 

STA 

PORTC 

-• 

382 

*** 

IS  *HYST'  SETTING  COMPLETE? 

383 

OOFS 

09  03  C7 

BRCLR 

FUNCT, PORTO, CHHYST 

NO...  KEEP  CHECKING  ’ 

SET'. 

384 

OOFB 

04  20  04 

BRSET 

NEGT IV, STAT, SIGN 

YES...  RESET  THE  DISPLAY. 

385 

OOFE 

1C  01 

BSET 

POST  IV, PORTS 

386 

0100 

20  02 

BRA 

DIR 

387 

0102 

ID  01 

SIGN 

BCLR 

POSTIV, PORTS 

388 

0104 

08  20  05 

OIR 

BRSET 

POSCT,STAT,SHOPOS 

389 

•* 

390 

0107 

CO  02  08 

JSR 

OUTCT 

391 

01 OA 

20  03 

BRA 

DUNCHG 

110 


392 

*** 

393 

01 OC 

CO 

02  E5 

SHOPOS 

JSR 

OUTPOS 

394 

*** 

395 

Q10F 

OB 

20  04 

DUNCHG 

BRCLR 

FLASH, STAT, NO  INT 

IF  THE  DISPLAY  IS  TO  BLINK... 

396 

0112 

A6 

07 

LOA 

#BIT2*BIT1*BIT0 

ENABLE  TIMER  INTERRUPT  AND  RESET 

397 

0114 

87 

09 

STA 

TCR 

TIMER  PRESCALER 

396 

0116 

20 

9C 

NO  I  NT 

BRA 

PAUSE 

PRIOR  TO  RETURNING. 

399 

*♦* 

400 

** 

401 

******* 

402 

**  MAXIMUM  EXECUTION  TINE  FON  THE  REMAINDER  OF  THE  PROGRAM  OCCURS 

403 

"  IF  THE  COUNTER  ROTATES  THROUGH  ZERO  AS  THE  DISPLAY  NQOE  IS  CHANGED 

404 

**  FROM  THE  BUNKING  NODE  TO  THE  COUNT  NODE  AT  THE  SAME  TINE  THAT  THE 

405 

•*  BUNKING  ROUTINE  IS  CAUSING  THE  DISPLAY  TO  TOGGLE  TO  SHOW  THE 

406 

**  POSITION  IN  DE6REES. 

407 

** 

MAXIMUM  EXECUTION  TIME  »  67  ♦  140  ♦  618  ■  825  CLOCK  CYCLES. 

408 

** 

409 

******* 

410 

** 

411 

**MOOE 

CHANGE  ROUTINE.  CHANGES  THE  DISPLAY  NODE  FROM 

412 

COUNT 

•>  POSITION  ->  BLINKING  ->  COUNT  •> _ (ETC.) 

413 

** 

MAXIMUM  EXECUTION  TINE  OF 

127  CLOCK  CYCLES  OCCURS  WHEN  THE 

414 

** 

DISPLAY  NQOE  IS  CHANGED  FROM  DISPLAYING  THE  COUNT  TO  DISPLAYING 

415 

** 

THE  POSITION  (IN  DEGREES). 

416 

•  * 

IF  THE  DISPLAY  IS  CHANGED 

FROM  BLINKING  TO  A  COUNT  DISPLAY 

417 

«* 

EXECUTION  TIME  IS  67  CLOCK  CYCLES. 

418 

** 

419 

0118 

IF 

OA 

CHMOOE 

BCLR 

B7,MR 

AVOID  REPEATED  INTERRUPTS. 

420 

** 

421 

011A 

OA 

20  10 

BRSET 

FLASH, STAT.D IS  CT 

IF  FLASHING.  DISPLAY  COUNT... 

422 

0110 

09 

20  07 

BRCLR 

POSCT , STAT ,D I SPOS 

IF  SHOWING  COUNT,  DISPLAY  POSITION... 

423 

0120 

1A 

20 

BSET 

FLASH, STAT 

ELSE,  BLINK. 

424 

** 

425 

0122 

A6 

07 

LDA 

MIT2+B1T1+BIT0 

ENABLE  TIMER  INTERRUPT  AND  RESET 

426 

0124 

B7 

09 

STA 

TCR 

TIMER  PRESCALER. 

427 

0126 

80 

RTI 

428 

** 

429 

0127 

18 

20 

OISPOS 

BSET 

POSCT, STAT 

430 

0129 

CO 

02  E5 

JSR 

OUTPOS  | 

|~  DISPLAY  CURRENT  POSITION,  AND  WAIT 

431 

01 2C 

80 

RTI 

-- 

432 

** 

433 

0120 

A6 

47 

DIS  CT 

LOA 

BBIT6+BIT2+BIT1+BIT0  DISABLE  TIMER  INTERRUPT  AND  RESET 

434 

012F 

B7 

09 

STA 

TCR 

TIMER  PRESCALER. 

435 

0131 

19 

20 

BCLR 

POSCT, STAT 

436 

0133 

IB 

20 

BCLR 

FLASH,  ST  AT 

1 

437 

** 

438 

0135 

CO 

02  D8 

JSR 

OUTCT 

j"  DISPLAY  CURRENT  COUNT,  AND  WAIT. 

439 

0138 

80 

RTI 

-- 

440 

** 

441 

442 

** 

443 

**  BLINK  ROUTINE.  INTERRUPT  ROUTINE  TO  CHANGE  THE  DISPLAY  FROM  POSITION 

444 

•* 

TO  COUNT  OR  VICE  VERSA  EVERY  31  ST  TIMER  INTERRUPT  IF  THE 

445 

** 

'FLASH 

'  BIT  OF  'STAT'  IS  SET. 

446 

** 

MAXIMUM  EXECUTION  TINE  OF 

140  CLOCK  CYCLES  OCCURS  WHEN  THE 

447 

** 

DISPLAY  IS  TOGGLED  FROM  A 

COUNT  DISPLAY  TO  A  POSITION  DISPLAY. 

448 

** 

449 

0139 

BLINK 

EOU 

S 

450 

0139 

OF 

09  DC 

BRCLR 

T I R, TCR, CHMOOE 

IF  THE  INTERRUPT  WAS  NOT  A  TIMER 

451 

** 

INTERRUPT  IT  MUST  BE  FROM  INT2. 

452 

** 

453 

013C 

IF 

09 

BCLR 

TIR.TCR 

AVOID  REPEATED  TIMER  INTERRUPTS. 

454 

*• 

455 

013€ 

3A  22 

DEC 

TIMCT 

IF  THERE  HAVE  BEEN  31  TIMER 

456 

0140 

27  01 

8EQ 

CHGDIS 

INTERRUPTS  (1  SEC),  IT'S  TIME  TO 

457 

** 

CHANGE  THE  DISPLAY. 

ill 


458 

0142 

80 

RTI 

OTHERWISE,  IT'S  BACK  TO  WORK. 

459 

** 

460 

0143 

A6  IF 

CHGOIS 

LDA 

831  RESET  TINCT  TO  31  (1  SEC.  INTERVAL). 

461 

0145 

B7  22 

STA 

TINCT 

462 

** 

463 

0147 

B6  20 

LDA 

STAT 

464 

0149 

A8  10 

EOR 

8X00010000  |—  CHANGE  'POSCT*  BIT  OF  'STAT'. 

465 

014B 

87  20 

STA 

STAT 

466 

** 

467 

0140 

08  20  04 

BRSET 

POSCT, ST AT, POSOUT  DECIDE  ON  CORRECT  DISPLAY. 

468 

469 

CHANGE  THE  DISPLAY  TO  SHOW  THE  COUNT .  *************** 

470 

*• 

471 

0150 

CD  02  D8 

JSR 

OUTCT 

472 

0153 

80 

RT! 

473 

*• 

474 

ft  1 

OR  HAVE  THE  DISPLAY  SHOW  THE  POSITION.  ****************** 

475 

«• 

476 

0154 

CD  02  E5 

POSOUT 

JSR 

OUTPOS 

477 

0157 

80 

RTI 

478 

479 

480 

481 

482 

483 

484 

485 

486 

487 

488 

489 

490 

491 

492 

493 

494 

495 

496 

497 

498 

499 

500 

501 

502 

503 

504 

505 


** 

*• 

** 


COUNT  ROUTINE. 

WHEN  A  COUNT  IS  RECEIVED  THIS  IS  THE  ENTRY  POINT  . 

MAXIMUM  EXECUTION  TIME  OP  618  CLOCK  CYCLES  OCCURS  WHEN  THE 
COUNTER  ROTATES  CCW  THROUGH  ZERO  AND  THE  POSITION  (IN  DEGREES) 
IS  BEING  DISPLAYED. 


**  CURRENT  DIRECTION  OF  ROTATION  IS  DETERMINED  BY  INSPECTING  THE  STATUS 
•*  OF  'CH  A<  AND  'CH  B'.  THE  FOUR  POSSIBILITIES  AND  THE  ASSOCIATED 
**  DIRECTION  OF  ROTATION  ARE  AS  SHOWN  BELOW.  NOTE  THAT  THIS  SCHEME 
**  PREVENTS  MULTIPLE  OSCILLATIONS  ABOUT  A  SINGLE  POINT  FROM 
**  REPEATEDLY  INCREMENTING  09  '  .ANTING  THE  COUNTER. 


** 

•• 

** 


** 

•• 


CM  j 

CH_B  j 

1  DIRECTION  [ 

|  OF  ROTATION  j 

|  COUNT  THE  PULSE? 

LO 

LO 

i  cw 

NO 

LO 

HI  | 

1  CCW 

YES 

HI 

LO 

j  CCW 

NO 

HI 

HI 

1  cw 

YES 

FIRST  SEE  IF  WE  ARE  SUPPOSED  TO  COUNT  THIS  INTERUPT. 


506 

0158 

COUNT 

EQU 

S 

507 

0158 

OA  03  01 

BRSET 

CH  B.PORTD.OKCT 

IF  CH  B  IS  LO  WE  DON'T  COUNT  THE 

508 

015B 

80 

RTI 

INTERRUPT. 

509 

*• 

510 

*  IF  THE  INTERRUP1 

r  IS  VALID  UPDATE  'STAT'.  ************** 

511 

•• 

512 

015C 

A6  7F 

OKCT 

LOA 

8X01111111 

513 

015E 

B4  20 

AND 

STAT 

SAVE  ALL  OF  THE  OLD  'STAT'  EXCEPT  THE 

514 

0160 

B7  20 

STA 

STAT 

DIRECTION  OF  ROTATION. 

515 

0162 

A6  80 

LDA 

8X10000000 

516 

0164 

B4  03 

AND 

PORTD 

'CH  A, PORTD'  INDICATES  THE  DIRECTION 

517 

* 

OF  ROTATION  AND  BECOMES  'UD.STAT'. 

518 

0166 

BA  20 

ORA 

STAT 

ADO  THE  RESULTS  TO  GET 

519 

0168 

B7  20 

STA 

STAT 

THE  NEW  'STAT'. 

520 

•• 

521 

**  DECIDE  IF 

THE  "SLACK”  DUE  TO 

BACKLASH/KYSTERESIS  HAS  BEEN  TAKEN  OUT. 

5  22 

** 

523 

016A 

OE  20  09 

BRSET 

UD.STAT.HYSTCK 

IF  ROTATING  CW  SEE  BELOW. 

112 


524 

0160 

86  IF 

LOA 

NYSTCT 

ELSE,  SEE  IF  UE  DECREMENT  THIS  TIME. 

525 

016F 

27  48 

BEQ 

ecu 

IF  HYSTCT*0,  00  TO  THE  COUNT  DOUN 

526 

** 

ROUTINE. 

527 

0171 

*0  01 

sue 

*1 

ELSE,  DECREMENT  THE  HYSTERESIS  COUNTER, 

528 

0173 

87  IF 

ST* 

HYSTCT 

529 

0175 

80 

RTI 

AND  UAIT  FOR  THE  NEXT  INTERRUPT. 

530 

** 

531 

0176 

86  IE 

HYSTCK 

LOA 

HYST 

IF  ROTATING  CW.... 

532 

0178 

81  IF 

CMP 

NYSTCT 

AND  HYST  -  NYSTCT  _ 

533 

017A 

27  03 

BEO 

CW 

COUNT  THE  PULSE  . 

534 

017C 

3C  IF 

INC 

NYSTCT 

ELSE,  INCREMENT  THE  HYSTERESIS  COUNTER, 

535 

017E 

80 

RTI 

AND  UAIT  FOR  ANOTHER  PULSE. 

536 

** 

537 

** 

538 

******* 

539 

** 

540 

•* 

CLOCKWISE  ROUTINE. 

541 

** 

542 

01 7F 

cw 

EQU 

S 

543 

** 

544 

*♦* 

545 

669  6  6  8  6 

♦666666 

INCREMENT  THE 

BINARY  COUNTER  (BINCT).  ***************** 

546 

*** 

547 

017F 

B6  11 

LDA 

L08IN  BEGIN 

AT  THE  LSB  OF  THE  BINARY  COUNTER. 

548 

0181 

AB  01 

ADD 

61  LOBIN 

*  LOGIN  *  1  ;  CARRY  ->  C,CCR 

549 

0183 

87  11 

STA 

LOGIN 

550 

**• 

551 

0185 

86  10 

LDA 

HIBIN 

552 

0187 

*9  00 

ADC 

60 

ADD  THE  CARRY  TO  THE  HIGH  BYTE. 

553 

0189 

87  10 

STA 

HIBIN 

554 

*** 

555 

*** 

556 

•***.*•*••••*•***•  CLR/SET  MOD  32  APPROPRIATELY.  **•••****»**«•»»***** 

557 

*** 

558 

0188 

B6  11 

LDA 

L08IN 

IF  THE  LOU  FIVE  BITS  OF  'LOBIN'  ARE  NOT 

559 

0180 

*4  IF 

ANO 

6X00011111 

NOT  THEN  THE  NUMBER  ISN'T  A  MODULO  32  NUMBER. 

560 

018F 

26  04 

BNE 

NOT_32 

561 

*** 

562 

0191 

1C  20 

BSET 

MOO  32.STAT 

563 

0193 

20  02 

BRA 

DIRCHK 

564 

*** 

565 

0195 

10  20 

NOT_32 

BCLR 

MQ0_32,STAT 

566 

*** 

567 

*** 

568 

0197 

86  10 

DIRCHK 

LDA 

HIBIN 

569 

0199 

2B  19 

BMI 

CWNEG 

IF  HIBIN  <  0  ,  UE'RE  ROTATING  CU  TOWARD 

570 

*** 

THE  ORIGIN. 

571 

•** 

572 

019B 

26  10 

BNE 

CUPOS 

ELSE  IF  BINCT  .NE.  0  , 

573 

0190 

B6  11 

LOA 

LOBIN 

UE'RE  ROTATING  CU 

574 

019F 

26  0C 

BNE 

CUPOS 

AUAY  FROM  THE  ORIGIN. 

575 

*** 

576 

01A1 

15  20 

BCLR 

NEGTIV.STAT 

ELSE,  WE'VE  GONE  THROUGH  ORIGIN  IN  CU 

577 

*** 

DIRECTION.  CLR  NEGATIVE  SIGN. 

578 

01*3 

AE  12 

LOX 

6PTR3  -- 

579 

01*5 

7F 

CLRIT2 

CLR 

.X 

580 

01*6 

5C 

INCX 

- 

•RESET  ALL  COUNTERS  AND  DEGRES  TO  ZERO. 

581 

01*7 

*3  19 

CPX 

6TH0UTH  — 

582 

01*9 

23  F* 

BLS 

CLRIT2  - 

583 

01*8 

20  4C 

BRA 

UPOUT 

UPDATE  OUTPUT. 

584 

585 

01*0 

*0  5E 

CUPOS 

8SR 

AOOBCO 

586 

01 AF 

CO  02  32 

JSR 

INCPOS 

587 

0182 

20  45 

BRA 

UPOUT 

588 

*•* 

589 

0184 

CO  02  7* 

CWNEG 

JSR 

SU8BC0 
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590 

0187 

CO  02  9A 

JSR 

DECPOS 

591 

01  BA 

20  30 

BRA 

UPOUT 

592 

ftft* 

593 

ftft 

tttiiil 

********* 

594 

595 

ftft 

596 

ftft 

COUNTER-CLOCKWIK  ROUTINE. 

597 

ftft 

596 

01 BC 

ecu 

EOU 

S 

599 

ftft 

600 

ftftft 

601 

******* 

***  CLR/KT  NOD  32  APPROPRIATELY.  ********************* 

602 

ftftft 

603 

01BC 

B6  11 

LOA 

LOB IN  iF  THE  LOU  FIVE  BITS  OF  ‘LOBIN'  ARE  NOT 

604 

018E 

A4  IF 

AND 

8X00011111  ZERO  THEN  THE  NUNKR  ISN'T  A  MODULO  32  NUMKR 

605 

01C0 

26  04 

BNE 

NO  32 

606 

ftftft 

607 

01C2 

1C  20 

BSET 

MOO  32.STAT 

606 

01C4 

20  02 

BRA 

DEMIN 

609 

ftftft 

610 

01C6 

ID  20 

NO  32 

BCLR 

NOD  32.STAT 

611 

ftft* 

612 

ftft* 

613 

rftftftftftftftft 

DECREMENT  THE  BINARY  COUNTER  (BINCT).  **************** 

614 

ftft* 

615 

01C8 

B6  11 

DECS IN 

LOA 

LOGIN  KGIN  AT  THE  LSB  OF  THE  BINARY  COUNTER. 

616 

01CA 

AO  01 

SUB 

#1  LOBIN  «  L08IN  -  1  ;  BORROW  ->  C.CCR 

617 

01CC 

B7  11 

STA 

LOB  IN 

618 

ftftft 

619 

01 CE 

B6  10 

LOA 

HIBIH 

620 

01D0 

A2  00 

SBC 

«0  SUBTRACT  THE  CARRY  FROM  THE  HIGH  BYTE. 

621 

0102 

B7  10 

STA 

HI8IN 

622 

ftft* 

623 

01D4 

B6  10 

LOA 

HIBIN 

624 

0106 

2A  IB 

BPL 

CCUPOS  IF  HIBIN  .GE.  0  .  UE'RE  ROTATING  CCU  TOWARD 

625 

ftft* 

THE  ORIGIN. 

626 

0108 

A1  FF 

CMP 

#-1 

627 

01DA 

26  10 

BNE 

CCWNEG  --  ELK  IF  BINCT  .NE.  -1  , 

628 

010C 

B6  11 

LOA 

LOBIN  --WE'RE  ROTATING  CCU  AWAY 

629 

01DE 

A1  FF 

CMP 

#-1  -•  FROM  THE  ORIGIN. 

630 

01E0 

26  OA 

BNE 

CCWNEG  -- 

631 

01E2 

14  20 

BSET 

NEGTIV.STAT  ELK,  WE'VE  GONE  THROUGH  ORIGIN  IN  CCW 

632 

*** 

DIRECTION.  KT  NEGATIVE  SIGN. 

633 

ftftft 

AW)  SET  ALL  COUNTERS  APPROPRIATELY. 

634 

01 E4 

AE  12 

LDX 

•PTR3  - 

635 

01E6 

7F 

CLREM 

CLR 

,x 

636 

01E7 

5C 

INCX 

--  REKT  ALL  COUNTERS  AND  DEGRES  TO  ZERO. 

637 

01 E8 

A3  19 

CPX 

fTHOUTH  -- 

638 

01EA 

23  FA 

BLS 

CLREM  -- 

639 

ftftft 

640 

01EC 

AD  IF 

CCWNEG 

BSR 

ADDBCD 

641 

01EE 

CO  02  32 

JSR 

INCPOS 

642 

01F1 

20  06 

BRA 

UPOUT 

643 

*** 

644 

01 F3 

CO  02  7A 

CCWPOS 

JSR 

SUBBCO 

645 

01 F6 

CO  02  9A 

JSR 

DECPOS 

646 

ftft* 

647 

ft** 

648 

ft* 

649 

i«tii*aiAUiut6***fta*tftftMiiAtiii*iut***ftftiitftiit*ft***ft* 

650 

ft* 

651 

**  OUTPUT  ROUTINE.  ROUTINE  TO  PRINT  DATA  TO  THE  OUTPUT  PORTS.  BY 

652 

ft* 

CALLING  THE  APPROPRIATE  SUBROUTINE.! 'OUTCT'  TO  OUTPUT  THE 

653 

ft* 

THE  COUNT  AND  'OUTPOS'  TO  OUTPUT  THE  POSITION). 

654 

ft* 

655 

01 F9 

UPOUT 

EOU 

S 
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656 

** 

657 

01 F9 

04 

20  04 

BRSET 

NEGT1V,STAT, MINUS  •• 

658 

01 FC 

1C 

01 

BSET 

POSTIV, PORTS 

659 

01 FE 

20 

02 

BRA 

DISCHK 

660 

** 

SET  THE  NEGATIVE  SIGN 

661 

0200 

10 

01 

MINUS 

BCLR 

POSTIV, PORTS  APPROPRIATELY. 

662 

** 

663 

0202 

09 

20  04 

DISCHK 

BRCLR 

POSCT.STAT.PUTCT 

664 

** 

665 

0205 

CD 

02  E5 

JSR 

OUTPOS 

666 

0208 

80 

RTI 

667 

** 

668 

0209 

CO 

02  D8 

PUTCT 

JSR 

OUTCT 

> 

669 

020C 

80 

RTI 

670 

** 

6/1 

******* 

672 

•*»***' 

*****  SUBROUTINE  TO  INCREMENT  THE  BCD  COUNTER  (BCDCT).  ********* 

673 

*•* 

674 

0200 

B6 

16 

ADO  BCD 

LDA 

CTPTR1 

675 

020 F 

AB 

01 

ADO 

#1 

676 

0211 

A1 

63 

CMP 

#99  CTPTR  >  99  7 

6 77 

0213 

23 

05 

BLS 

OKI  NO,  UE'RE  OK  HERE.  LOOK  UP  THE  FIRST  TUO  DIGITS. 

678 

0215 

AO 

64 

SUB 

#100  YES...  MODIFY  THE  CTPTR, 

679 

0217 

99 

SEC 

SET  THE  CARRY,  AND 

680 

0218 

20 

01 

BRA 

OKI A  USE  TABLE  LOOK  UP. 

681 

*•* 

682 

021A 

98 

OKI 

CLC 

NO  CARRY  EXISTS  IF  WE  ENTER  AT  THIS  POINT, 

683 

021 B 

B7 

16 

OKI  A 

STA 

CTPTR1  -- 

684 

0210 

97 

TAX 

-- 

685 

•** 

-  LOOK  UP  THE  TUO  LEAST  SIGNIFICANT  DIGITS. 

686 

021 E 

06 

03  28 

LOA 

TABLE, X  -- 

687 

0221 

B7 

IB 

STA 

TENONE  — 

688 

0223 

24 

OC 

BCC 

NOMO  ANO  CONTINUE  ONLY  IF  THERE  WAS  A  CARRY. 

689 

*** 

. 

690 

*** 

691 

0225 

B6 

15 

LOA 

CTPTR2 

692 

0227 

A9 

00 

ADC 

#0  ADD  THE  CARRY. 

693 

0229 

B7 

15 

STA 

CTPTR2  -- 

4 

694 

022B 

97 

TAX 

-- 

695 

*** 

-•  LOOK  UP  THE  NEXT  TUO  DIGITS  IN  THE  TABLE. 

696 

022C 

06 

03  28 

IDA 

TABLE.X  -- 

697 

022 F 

B7 

1A 

STA 

HUNDRD  -• 

y 

698 

**• 

699 

0231 

81 

NOMO 

RTS 

700 

*** 

701 

********************************************************* 

702 

*  SUBROUTINE  TO  INCREMENT  THE  POSITION  COUNTER  (DECRES).  ******* 

703 

*** 

704 

**** 

FIRST  CHECK  TO  SEE  IF  THE  BINARY  COUNTER  HAS  REACHED  A  HOOULO  32 

705 

NUMBER 

706 

***• 

707 

0232 

00 

3 

O 

<M 

INCPOS 

BRCLR 

MOO  32, ST AT, INC7  'MOD  32,STAT'  SET  7 

708 

**** 

709 

0235 

A6 

08 

LDA 

#8  YES  ... 

710 

0237 

20 

02 

BRA 

INC  INCREMENT  THE  POSITION  BY  0.008  DEGREES. 

711 

**** 

712 

0239 

A6 

07 

INC7 

LDA 

#7  NO  .... 

713 

023B 

B7 

ID 

INC 

STA 

POSINC  INCREMENT  THE  POSITION  BY  0.007  DEGREES. 

714 

**** 

715 

*•'*  ROUTINE  TO 

INCREMENT  THE  POSITION  COUNTER  , 'DEGREES' , BY  A 

716 

*•** 

PREDETERMINED  AMOUNT,  'POSINC'. 

717 

**** 

718 

0230 

B6 

14 

LDA 

PTR1 

•t 

719 

023F 

•B 

ID 

ADO 

POSINC 

720 

0241 

A1 

09 

CMP 

#9  PTR1  »  9  7 

721 

0243 

23 

05 

BLS 

0K3  NO,  UE'RE  OK  HERE.  LOOK  UP  THE  FIRST  DIGIT. 
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#10 


722 

0245 

AO  OA 

723 

0247 

99 

724 

0248 

20  01 

725 

726 

024A 

98 

727 

0248 

87  14 

728 

024D 

97 

729 

730 

024E 

D6  03  28 

731 

0251 

B7  19 

732 

0253 

24  24 

733 

734 

735 

0255 

86  13 

736 

0257 

A9  00 

737 

0259 

A1  63 

738 

02SB 

23  05 

739 

0250 

AO  64 

740 

02SF 

99 

741 

0260 

20  01 

742 

743 

0262 

98 

744 

0263 

B7  13 

745 

0265 

97 

746 

747 

0266 

D6  03  28 

748 

0269 

B7  18 

749 

0268 

24  OC 

750 

751 

752 

026D 

B6  12 

753 

026F 

A9  00 

754 

0271 

B7  12 

755 

0273 

97 

756 

757 

0274 

D6  03  28 

758 

0277 

B7  17 

759 

760 

0279 

81 

761 

762 

763 

764 

765 

0K3A 


YES...  MODIFY  THE  CTPTR, 
SET  THE  CARRY,  AHD 
USE  TABLE  LOOK  UP. 


OKS 

CLC 

HO  CARRY  EXISTS  IF  WE  ENTER  AT  THIS  POINT. 

0K3A 

STA 

PHI 

TAX 

-- 

**** 

-- 

LOOK  UP  THE  LEAST  SIGNIFICANT  DIGIT. 

LDA 

TABLE,X  ~ 

STA 

TNOUTH  - 

BCC 

DONE 

AND  CONTINUE  ONLY  IF  THERE  WAS  A  CARRY. 

LOA 

ADC 

CMP 

SLS 

SUB 

SEC 

BRA 


MO  CARRY  EXISTS  IF  WE  EMTER  AT  THIS  POIMT. 

PTR2 

—  LOOK  UP  THE  MEXT  TWO  DIGITS  IN  THE  TABLE. 

TABLE, X  -* 

HUNDTH  — 

DONE  AND  CONTINUE  ONLY  IF  THERE  WAS  A  CARRY. 


LDA  PTR3 

ADC  #0  ADD  THE  CARRY. 

STA  PTR3 

TAX 

****  -*  LOOK  UP  THE  NEXT  TWO  DIGITS  IN  THE  TABLE. 

LDA  TABLE, X  -- 

STA  ONEDEG  -- 

*•»« 

DONE  RTS 
••• 


OKA  CLC 

0K4A  STA 

TAX 

***• 

LDA 

STA 

BCC 


PTR2 

#0  ADO  THE  CARRY. 

#99  PTR2  >99  7 

0K4  HO,  WE'RE  OK  MERE.  LOOK  UP  THE  NEXT  TWO  DIGITS. 

#100  YES. ..NOOIFY  THE  CTPTR, 

SET  THE  CARRY, 

0K4A  AHD  USE  TABLE  LOOK  UP. 


SUBROUTINE  TO  DECREMENT  THE  BCD  COUNTER  (BCDCT). 


766 

027A 

B6  16 

SUBBCD 

LDA 

CTPTR1 

767 

027C 

AO  01 

SUB 

#1 

CTPTR  >  99  ? 

768 

027E 

24  03 

BCC 

0K6 

NO,  WE'RE  OIC  HERE.  LOOK  UP  THE  FIRST  TWO  DIGITS. 

769 

0280 

AB  64 

ADO 

#100 

YES,  NOOIFY  THE  CTPTR,  AND 

770 

0282 

99 

SEC 

GENERATE  A  BORROW. 

771 

*** 

772 

0283 

B7  16 

0K6 

STA 

CTPTR 1 

-• 

773 

0285 

97 

TAX 

-- 

774 

*** 

—  LOOK  UP  THE  TWO  LEAST  SIGNIFICANT  DIGITS. 

775 

0286 

06  03  28 

LDA 

TABLE, X 

-- 

776 

0289 

B7  IB 

STA 

TENONE 

-- 

777 

0288 

24  OC 

BCC 

COMPLT 

ANO  CONTINUE  ONLY  IF  THERE  WAS  A  BORROW. 

778 

*** 

779 

*** 

780 

0280 

86  15 

LDA 

CTPTR2 

781 

028F 

A2  00 

SBC 

#0 

SUBTRACT  THE  CARRY.  CTPTR  >  99  ? 

782 

0291 

B7  15 

STA 

CTPTR2 

-- 

783 

0293 

97 

TAX 

-- 

784 

*«• 

—  LOOK  UP  THE  NEXT  TWO  DIGITS  IN  THE  TABLE. 

785 

0294 

06  03  28 

LDA 

TABLE, X 

-- 

786 

0297 

87  1A 

STA 

HUNDRD 

-- 

787 

*** 

A 


r 
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788 

789 

0299 

81 

CONPIT 

*** 

RTS 

790 

791 

SUBROUTINE  TO  DECREMENT  THE  POSITION  COUNTER  (OEGRES).  ******* 

792 

793 

****  FIRST  CHECK  TO  SEE  IF  THE  BINARY  COUNTER  HAS  REACHED  A  MODULO  32 

794 

+*** 

NUMBER. 

795 

#*+« 

796 

029A 

00  20  04 

DECPOS 

BRCLR 

N0D_S2,STAT,DEC7  'MOO_32,STAT'  SET  7 

797 

**** 

798 

0290 

A6  08 

LDA 

«  YES... 

799 

029F 

20  02 

BRA 

DEC  DECREMENT  THE  POSITION  BY  0.008  DEGREES. 

800 

+*** 

801 

02A1 

A6  07 

DEC7 

LDA 

#7  NO  .... 

802 

02A3 

•7  10 

DEC 

STA 

POSIMC  DECREMENT  THE  POSITION  BY  0.007  DEGREES. 

803 

**** 

804 

****  ROUTINE  TO 

DECREMENT  THE  POSITION  COUNTER  , 'DEGREES' , BY  A 

80S 

**** 

PREDETERMINED  AMOUNT,  'POSINC'. 

806 

**** 

807 

02A5 

B6  14 

LDA 

PTR1 

808 

02A7 

BO  10 

SUB 

POSIMC  PTR1  <  0  ? 

809 

02A9 

24  03 

BCC 

OKS  NO,  UE'RE  OK  HERE.  LOOK  UP  THE  FIRST  DIGIT. 

810 

02AB 

AB  OA 

ADO 

*10  YES,  MOOIFY  THE  CTPTR,  AM) 

811 

02AD 

99 

SEC 

GENERATE  A  BORROW. 

812 

***• 

813 

02AE 

B7  14 

0K8 

STA 

PTR1 

814 

02B0 

97 

TAX 

-- 

815 

•*+* 

••  LOOK  UP  THE  LEAST  SIGNIFICANT  DIGIT. 

816 

02B1 

D6  03  28 

LDA 

TABLE, X  — 

817 

02B4 

B7  19 

STA 

THOUTH  -- 

818 

02B6 

24  IF 

BCC 

DUN SUB  AND  CONTINUE  ONLY  IF  THERE  WAS  A  BORROW. 

819 

*** 

820 

•** 

821 

02B8 

B6  13 

LDA 

PTR2 

822 

02BA 

A2  00 

SBC 

*0  SUBTRACT  THE  BORROW.  PTR2  <07 

823 

02BC 

24  03 

BCC 

0K9  NO,  UE'RE  OK  HERE.  LOOK  UP  THE  NEXT  TWO  DIGITS. 

824 

02BE 

AB  64 

ADO 

*100  YES,  MODIFY  THE  CTPTR,  AND 

825 

02C0 

99 

SEC 

GENERATE  A  BORROW. 

826 

*** 

827 

02C1 

B7  13 

0K9 

STA 

PTR2 

828 

02C3 

97 

TAX 

-- 

829 

**t 

--  LOOK  UP  THE  NEXT  TWO  DIGITS  IN  THE  TABLE. 

830 

02C4 

06  03  28 

LDA 

TABLE, X  -- 

831 

02C7 

B7  18 

STA 

HUNOTH  •• 

832 

02C9 

24  CC 

BCC 

DUN SUB  AND  CONTINUE  ONLY  IF  THERE  WAS  A  CARRY. 

833 

834 

*** 

835 

02CB 

B6  12 

LDA 

PTR3 

836 

02CD 

A2  00 

SBC 

*0  SUBTRACT  THE  BORROW. 

837 

02CF 

B7  12 

STA 

PTR3 

838 

0201 

97 

TAX 

839 

**** 

--  LOOK  UP  THE  NEXT  TWO  DIGITS  IN  THE  TABLE 

840 

0202 

06  03  28 

LDA 

TABLE, X  -* 

841 

0205 

B7  17 

STA 

ONEDEG  •• 

842 

843 

0207 

81 

DUN  SUB 

RTS 

844 

845 

*• 

846 

•* 

847 

******* 

******** 

********************************************************* 

848 

•• 

849 

**  OUTPUT  COUNT 

(OUTCT).  SUBROUTINE  TO  MOVE  THE  CURRENT  COUNT  (BCOCT) 

850 

** 

TO  THE  OUTPUT  PORTS.  REMOVES  THE  DECIMAL  POINT  FROM  THE 

851 

** 

DISPLAY  AND  BLANKS  ALL  BUT  THE  LEAST  SIGNIFICANT  DIGIT.  ALSO 

852 

** 

SETS  THE  MINUS  SIGN  IF  APPROPRIATE. 

853 

** 
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854 

0208 

OUTCT 

EQU 

S 

855 

«* 

858 

0208 

86  18 

IDA 

TENONE 

857 

02DA 

87  02 

STA 

PORTC 

858 

** 

859 

02DC 

86  1A 

IDA 

HUNDRD 

860 

02DE 

87  00 

STA 

PORTA 

861 

** 

862 

02E0 

IE  01 

BSET 

DECPT, PORTS 

863 

02E2 

19  01 

8CLR 

BLANK, PORTS 

864 

#* 

865 

02E4 

81 

RTS 

866 

++ 

867 

868 

** 

869 

**  OUTPUT  POSITION  (OUTPOS). 

SUBROUTINE  TO  NONE  THE  CURRENT  POSITION 

870 

** 

COUNT  (BCDCT)  TO  THE  OUTPUT  PORTS.  THE  DECIMAL  POINT  IS 

871 

** 

DISPLAYED  ,  AND  ONLY  THE  MOST  SIGNIFICANT  DIGIT  IS  BLANKED. 

872 

** 

873 

02E5 

OUTPOS 

EQU 

S 

874 

#* 

875 

02E5 

86  19 

LDA 

THOUTH  — 

876 

02E7 

A1  05 

CMP 

#5 

877 

02E9 

25  20 

BLO 

TRUNC 

IF  5  >  'THOUTH'  SIMPLY  TRUNCATE  THE 

878 

02EB 

86  18 

LDA 

HUNDTH 

--  DISPLAY.  OTHERWISE... 

879 

02ED 

A4  09 

AND 

89 

—  IF  THE  LAST  DIGIT  ISN'T  A  NINE  IT  IS 

880 

02EF 

A1  09 

CMP 

89 

-•  EASY  TO  ROUND  UP.  JUST  ADD  A  ONE. 

881 

02F1 

26  ID 

BNE 

DECIMAL 

-- 

882 

02F3 

86  18 

LDA 

HUNOTH 

••  BUT  IF  THE  LAST  DIGIT  IS  A  NINE  CHECK  TO 

883 

02F5 

A1  99 

CMP 

8899 

--  SEE  IF  IT'S  99.  IF  SO  IT  GETS  GRIM. 

884 

02F7 

27  04 

BEO 

UGLY 

885 

02F9 

AB  07 

ADD 

87 

--  IF  THE  NUMBER  IS  X9  AND  X  .HE.  9,  THEN 

886 

02FB 

20  ID 

BRA 

PCOUT 

-•  JUST  ADD  SEVEN  TO  ROUND  UP.  DUE  TO 

887 

*• 

-•  HEX I DECIMAL. 

888 

** 

•*  IF  THE  LOU  TWO  DIGITS  ARE  BOTH  HINES 

889 

02  F0 

A6  00 

UGLY 

LDA 

800 

-  AND  WE  HEED  TO  ROUND  UP.... 

890 

02FF 

87  02 

STA 

PORTC 

MAKE  THE  LOU  TWO  DIGITS  BOTH  ZEROS 

891 

0301 

99 

SEC 

AND  SET  THE  CARRY. 

892 

** 

893 

0302 

86  17 

LDA 

ONEDEG  ~ 

CHECK  THE  LAST  DIGIT  AS  BEFORE. 

894 

0304 

A4  09 

AND 

89 

IF  USING  THIS  PORTION  OF  THE  COOE 

895 

0306 

A1  09 

CMP 

89 

-  THERE  HAD  TO  BE  A  CARRY. 

896 

0308 

26  13 

BNE 

NEXT 

*•  IF  THE  LAST  DIGIT  IS  A  NINE  DO  THE 

897 

030A 

86  17 

LDA 

ONEDEG 

--  CARRY  HERE.  IF  NOT  USE  THE  ADC 

898 

030C 

AB  07 

ADD 

87 

INSTRUCTION  TO  TAKE  CARE  OF  IT 

899 

030E 

20  11 

BRA 

PAOUT 

BELOW. 

900 

0310 

86  18 

DECIMAL 

LDA 

HUNDTH  — 

901 

0312 

AB  01 

ADD 

81 

902 

SHB 

-*  THIS  IS  ALL  THAT  NEEDS  TO  BE  OONE  IF 

903 

0314 

87  02 

STA 

PORTC 

THE  LAST  DIGIT  IS  NOT  A  NINE. 

904 

0316 

20  05 

BRA 

NEXT 

905 

906 

0318 

86  18 

TRUNC 

LDA 

HUNDTH  -- 

907 

031A 

87  02 

PCOUT 

STA 

PORTC 

AND  IF  THERE  IS  HO  CARRY  IT'S  EVEN  EASIER. 

908 

031C 

98 

CLC 

-- 

909 

*• 

910 

0310 

86  17 

NEXT 

LDA 

ONEDEG 

911 

031F 

A9  00 

ADC 

80 

912 

0321 

87  00 

PAOUT 

STA 

PORTA 

913 

** 

914 

0323 

18  01 

BSET 

BLANK, PORTS 

915 

0325 

IF  01 

BCLR 

DECPT, PORTS 

916 

917 

0327 

81 

RTS 

918 

919 
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920 

** 

921 

**  SET  UP  THE 

TABLE  TO  BE  USED  WITH  BCD  INCREMENT/DECREMENT  ROUTINES. 

922 

*• 

923 

• 

ENOS 

924 

• 

DATA 

925 

0328 

00  01  02  03  04 

TABLE 

FC8 

800,801 ,802,803,804,805,806,807,808,809 

0320 

05  06  07  08  09 

926 

0332 

10  11  12  13  14 

FCB 

810,811,812,813,814,815,816,817,818,819 

0337 

15  16  17  18  19 

927 

033C 

20  21  22  23  24 

FC8 

820,821,822,823,824,825,826,827,828,829 

0341 

25  26  27  28  29 

928 

0346 

30  31  32  33  34 

FC8 

830,831,832,833,834,835,836,837,838,839 

0348 

35  36  37  38  39 

929 

0350 

40  41  42  43  44 

FC8 

840,841 ,842,843,844,845,846,847,848,849 

0355 

45  46  47  48  49 

930 

035A 

50  51  52  53  54 

FCB 

850,851 ,852,853,854,855,856,857,858,859 

035F 

55  56  57  58  59 

931 

0364 

60  61  62  63  64 

FCB 

860,861 ,862,863,864,865,866,867,868,869 

0369 

65  66  67  68  69 

932 

036E 

70  71  72  73  74 

FCB 

870,871,872,873,874,875,876,877,878,879 

0373 

75  76  77  78  79 

933 

0378 

80  81  82  83  84 

FCB 

880,881 ,882,883,884,885,886,887,888,889 

0370 

85  86  87  88  89 

934 

0382 

90  91  92  93  94 

FCB 

890,891,892,893,894,895,896,897,898,899 

0387 

95  96  97  98  99 

935 

* 

ENOS 

936 

* 

COOE 

937 

r**«*ttiiiM«niAm6****<iii*H*inm*tt**t***MM***t**** 

938 

** 

939 

*• 

SET  UP  MASK  OPTION  REGISTER. 

940 

** 

941 

038C 

ABSOLUTE  JUST  TO  ENSURE  THAT  THE  INTERRUPT  VECTORS 

942 

** 

ARE  CORECTLY  LOCATED. 

943 

** 

944 

•• 

945 

0F38 

ORG 

NOR 

946 

0F38 

07 

FCB 

0BIT2*B!T1*BIT0 

947 

*# 

948 

** 

COMMENTS: 

949 

** 

BIT  7 

CLOCK  SOURCE  0  -  CRYSTAL. 

950 

** 

BIT  6 

TIMER  OPTION  0  *  INTERNAL. 

951 

** 

BIT  5 

TINER/CLOCK  SOURCE  0  -  INTERNAL. 

952 

«* 

BIT  4 

NOT  USED. 

953 

•* 

BIT  3 

NOT  USED. 

954 

•* 

SIT  2 

SET  • 

955 

** 

BIT  1 

SET  •  PRESCALE  SELECT  111  ->  128 

956 

** 

BIT  0 

SET  - 

957 

«* 

958 

** 

•*•*•*•« 

959 

960 

** 

961 

** 

ASSIGN  INTERRUPT  VECTORS. 

962 

** 

963 

OFFS 

ORG 

INTRPT 

964 

8HB 

965 

OFFS 

0139 

FOB 

BLINK  TINER/INT2  INTERRUPT  VECTOR. 

966 

OFFA 

0158 

FOB 

COUNT  EXTERNAL  INTERRUPT  VECTOR. 

967 

OFFC 

0158 

FOB 

COUNT  SOFTWARE  INTERRUPT  VECTOR,  NOT  USED. 

968 

0FFE 

0080 

FOB 

RESTRT  RESET  VECTOR. 

969 

•* 

970 

•* 

971 

•* 

972 

ENOS 

973 

1000 

ENO 
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